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ABSTRACT 


Steady-state  and  total  decoupling  schemes  for 
multivariable  systems  are  used  to  develop  two 
automatic  control  systems  for  the  vertical  motion  of  a 
fictitious  submarine.  A linearized  mathematical  model 
is  derived  from  a non-linear  model  in  six  degrees  of 
freedom.  Ecth  designs  are  simulated  and  evaluated  with 
respect  to  performance,  simplicity  of  design 
procedure,  and  grade  of  complexity.  The  controller, 
designed  via  the  steady-state  decoupling  method,  is 
implemented  in  the  non-linear  model  and  tested  under 
various  operating  conditions. 
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I.  INTRODUCTION 

The  extreme  importance  of  automatic  control  has  become 
obvious  for  example  in  space  vehicle  control  and  missile 
guidance  where  manual  control  is  not  feasible.  In  addition 
it  can  provide  means  to  relieve  people  from  tedious  routine 
and  repetitive  manual  operations. 

The  complexity  of  a submarine  offers  a wide  area  of 
control  problems.  Eeep  water  and  near  surface  depth  keeping, 
maneuvering,  hovering,  fuel  economy,  safety,  crew  comfort, 
etc.  require  precise  controls. 

Characteristic  for  a submarine  is  translation  in  three 
dimensions,  where  depth  control  is  of  essential  importance. 
The  automatic  control  of  motion  in  the  vertical  plane,  i.e. 
depth  and  pitch  control,  is  the  subject  of  this  thesis. 

Three  sets  of  planes,  the  rudder,  the  fairwater  and 
stern  plane,  the  propulsion  system,  and  a ballast  system  can 
be  used  to  maneuver  the  submarine.  The  objective  is  to 
design  a controller  for  depth  changing  maneuvers  by 
automatic  control  of  the  fairwater  and  stern  plane. 

Previous  designs  were  based  on  Optimal  Control  Theory, 
requiring  feedback  of  both  position  and  rate  information. 
These  informations  are  easily  available  when  the  submarine 
is  equipped  with  an  inertial  guidance  system.  Rate 
information  may  be  not  available,  as  for  example  in  the 
German  coastal  submarines.  It  may  also  be  a desirable 
feature  to  have  reduced  sensor  requirements.  In  these  cases 
a different  design  approach  must  be  used  using  position 
feedback  only. 


7 


This  thesis  investigates  two  possible  design  methods, 
steady-state  and  total  decoupling.  As  a basis  for  both 
designs  a lirear  model  is  developed  and  validated. 

Steady-state  decoupling  is  achieved  by  designing  a 
cascaded  diagonal  compensator  matrix,  using  classical 
single-lccp  techniques.  Based  on  the  desired  response 
characterist ics  the  total  decoupling  scheme  leads  to  a 
cascaded  compensator  matrix  with  off-diagcnal  terms.  Both 
designs  are  simulated  and  evaluated  with  respect  to 
performance,  simplicity  of  design  procedure,  and  grade  of 
complexity. 
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II.  SIMULATION  MODELS 


A.  STANEARE  MODEL 

A set  of  " Standard  Equations  of  Motion  for  Submarine 
Simulation  " was  developed  by  NSRDC  (Ref.  1).  Equations  and 
additional^  auxiliary  equations  are  repeated  in  Appendix  A. 

These  equations  are  referred  to  a right-hand  orthogonal 
system  of  moving  axes,  fixed  in  the  body  with  its  origin 
located  at  the  center  of  mass  (CG)  of  the  body.  The 
x-z-plane  is  the  principle  plane  of  symmetry  ( vertical 
center  plane  for  submarines  );  the  x-axis  is  parallel  to  the 
baseline  cf  the  body.  Angular  velocity  components,  forces, 
and  moments  are  shewn  in  Pig.  1. 

The  equations  are  written  in  a form  utilizing 
nondimensicnalized  hydrodynamic  coefficients  and  are 
applicable  tc  the  rigid  body  motions  of  submarines  and  other 
submerged  vehicles.  Complete  sets  of  hydrodynamic 
coefficients  have  been  determined  by  NSRDC.  The 
coefficients  for  a fictitious  submarine  used  in  this  thesis 
stem  frem  a submarine  simulation  program  developed  in 
Ref.  2.  A notation  for  the  various  terms  in  the  equations 
including  the  hydrodynamic  coefficients  is  given  in  Appendix 

B.  Numerical  values  of  coefficients  and  parameters  are  given 
in  Appendix  C.  All  coefficients  of  the  terms  containing 
( -1)  and  UC  are  set  to  zero.  These  terms  reflect  the 
incremental  changes  in  forces  and  moments  - generated  by 
propeller  rpu  - due  to  either  over  or  underpropulsion . For 
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the  moderate  changes  in  ahead  speed  involved  in  most  normal 
maneuvers  all  terms  can  be  neglected.  The  coefficients  used 
in  this  thesis  apply  only  to  the  deeply  submerged  case,  free 
of  near- surface,  bottom,  and  vail  effects. 

As  Bef.  1 points  out,  correlation  studies  and 
preliminary  comparisons  have  shown  that  the  "Standard 
Equations"  together  with  a given  set  of  coefficients  yield 
accurate  predictions  of  normal  maneuvers  in  submerged  ahead 
motion.  The  "Standard  Equations  of  Motion"  will  be  referred 
to  as  "Non-linear  Model". 

In  Bef.  2 H.L.Drurey  translated  these  equations  into 
Digital  Simulation  Language  (DSL) . The  system  of  six 
equations  was  solved  simultaneously  by  an  approach  using 
Cramer's  rule  developed  and  programmed  by  Ref.  3.  The 
cofactors  for  the  set  of  hydrodynamic  coefficients  used  in 
this  thesis  were  calculated  by  Drurey  and  are  used  as 
parameters.  The  validity  of  the  DSL  implementation  has  been 
shewn  by  Bef.  2. 

As  this  model  contains  non-linear  terms  it  is  not 
appropriate  fer  the  chosen  design  approach  which  is  based  on 
the  linearity  of  the  system.  It  was  necessary  to  find  a 
linear,  representative  approximation  of  the  "Non-linear 
Model". 


1 1 
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DERIVATICN  OF  THE  LINEARIZED  MODEL 


This  section  describes  the  assumptions,  procedures,  and 
tests  tc  validate  the  linear  model. 


1 . Assumptions 

* Forward  speed  is  constant 

An  attempt  to  linearize  about  the  axial  speed,  u, 
which  affects  nearly  every  term  in  the  standard  equations, 
would  ; m ly  a great  deal  of  complexity.  Thus  the  forward 
speed  was  assumed  to  be  constant.  This  means  that  either  the 
forward  speed  variations  are  small  and  can  be  neglected  or 
if  variations  are  large  they  impose  a control  problem  and 
will  be  solved  accordingly. 

* Roll  angle  is  small 

In  submarine  maneuvering  large  roll  angles  occur 
only  in  the  fcrm  of  " Snap  Roll  ",  i.e.  high  speed  plus  hard 
over  rudder.  Onder  normal  conditions  depth-changing  and 
-keeping  maneuvers  produce  very  small  roll  angles.  Therefore 
the  roll  angle  can  be  neglected. 

* Cross  products  of  inertia  may  be  neglected 

Ihis  assumption  is  common  to  all  submarine 
siaulaticns  because  the  hull  and  interior  layout  of 

submarines  is  approximately  symmetric. 
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All  terms  involving  W are  neglected 

i 

This  is  possible  because  the  submarine  was  assumed 
to  be  in  trim. 

* The  submarine  can  be  approximated  by  a linear  model 

The  linear  equations  are  assumed  to  be  a valid 
representation  in  the  depth- keeping  and  depth-changing  mode 
of  operation  respectively.  This  assumption  is  not  obvious 
but  will  be  verified  via  simulation. 

These  assumptions  lead  to  the  decoupling  of  the  vertical 
plane  from  the  remaining  equations. 

2.  Cerivation  of  state  equations 

As  this  thesis  is  only  concerned  with  the  vertical 
plane,  the  linearization  of  the  horizontal  plane  is  omitted. 

Thus  the  linear  equations  are  (FORTRAN-Notation,see 
Appendix  L)  : 

4 3 

M + HDC1  - 0 C* d*Q  = L *ZCDCT*QDOT  ♦ L *ZWDOT*WDCT  ♦ 

3 2 

L *ZQDOT*UC*Q  + L *ZW*UC*W  + 

2 2 

L *UC  * (ZDS*DS  ♦ ZDB*DB)  (1) 


5 4 

IY*£ECT  = L *aUDOT*QDOT  ♦ I *!1Q*UC*Q  ♦ 

4 3 

L *MWDOT**iDOT  * L *HW*(JC*W  + 

3 2 

L *UC  (WDS*DS  + HDB*DB)  * 
B*ZE*PITCH  (2) 
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The  linearized  auxiliary  equations  are  : 


LFIDCT  = LQ  (3) 

L2E0T  = W - UOLPITCH  (4) 


Solving  equation  (1)  and  (2)  for  WDOT  and  LQDOT 
respectively  and  substituting  into  each  other  yields  the 
following  relations  : 


'kdot 

a a a 

11  12  13 

"w 

b 

1 1 

b 

12 

ic  dot 

a a a 

21  22  23 

LQ 

■f 

b 

21 

b 

22 

ic 

a a a 

31  32  33 

LPITCH 

b 

31 

b 

32 

(5) 


which  can  be  written  as 


i = Ax  + 3S 

a*  -w  v ~<V 

where 


(6) 


a 

1 1 

a 

12 

a 

13 

a 

21 


a 

22 


a 

23 


2 7 5 

= [L  *Z  W * UC  ♦ L *ZQDOT*HW*UC/  (IY-L  *MQDGT)  ]/y~ 

3 8 5 

= [L  *ZQ*UC  ♦ B*(JC  ♦ L *ZQDOT*ai2*(JC/  (IT-L  *BQDOT)  ]/f 

4 5 

= -[  L »ZQEOT*ZB*B/ (IY-L  *MQDOT)]/^ 

3 6 3 

= [L  *M  m ^UC  ♦ L *MtfDOT*ZW*UC/ (M-L  *ZWDOT)  ]/£ 

4 7 4 

= [L  ♦MC*UC  ♦ L *MWDOT*ZQ*OC  ♦ L *BWDOT*M*UC/ 


3 

(M-L  * Z hDOT)  ]/£ 
= -B*Zfc/£ 
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a =0.0 

31 

a = 1.0 

32 

a =0.0 

33 


2 2 7 2 5 

b = [L  *ZDS*UC  ♦ L *ZQDOT*MDS*UC  /(IY-L  *MQDOT)  ]/ 

2 2 7 2 5 

b = [L  *ZEE*UC  ♦ L *ZQDOT*MDB*UC  /(IY-L  *HCOOT)  ]/ 

3 2 6 2 3 

b = [L  ♦MDS*UC  ♦ L *MWDOT*ZDS*UC  / ( H-L  *ZHDOT)  ]/ 

2 1 

3 2 6 2 3 

b = [L  *MBE*OC  ♦ L *MWDOT*ZDB*UC  /(H-L  +ZWDOT)  ]/ 

22 

b =0.0 

3 1 

b =0.0 
32 

with 


v 3 8 5 

f=  H - L *ZHDOT  - L * ZQDOT* M if  DOT/  (I  Y-L  *H£DOT) 

5 8 3 

£ = IY  - L *MQDOT  - L *MW DOT*Z  QDOT/  ( H - L *ZHDOT) 


Vector  equation  (5)  describes  the  state  variable 
representation  of  the  linearized,  vertical  plane  equations 
of  notion.  However  the  state  vector  does  not  contain  ZDOT 
but  <4 . U represents  the  component  of  u in  the  z-direction, 
in  order  to  make  the  depth  a state  variable  one  wants  to  use 
LZDCT  which  represents  the  depth  change  in  the  z-direction. 
Thus  the  linearized  auxiliary  equation  (4)  is  used  for  the 
transformation 


LZDCT  = H - UC*LPITCH 
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By  definition 


IZECT 

“b 

= 

LC 

X = 

LQ 

LPITCH 

_LPITCH 

Using  the  linear  operator  M , the  new  set  of  state 
variables  is  formed 


where 


m = 


MX 


1 0 -uc 

0 1 0 
0 0 1 


equations  (6)  become 


then 


but 


thus 


- 1 ? 
M X 


-U 

AM  x ♦ BR 


/%*  'XW 


* -1* 
x = MAM  X ♦ M BR 

/V  'VV'V  ^ V -vV 


MB  = B = B 


* -u 

X = MAM  X ♦ BR 

« <v  V<V  V V 

which  can  be  rewritten  as 


X * Ax  ♦ BR 


(7) 
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f I 


where 


a [a  -UC  ] [ a +a  *UC ] 
1112  13  11 


21  22 

0.0  1.0 


[a  *UC+a  ] 
21  23 


this  can  te  written  as 


A 1 1 *UC  A 1 2*UC  [ A 1 3 + A 14*UC  ] 


A2 1 *GC  A22*OC  [ A23*UC  + A24  ] 

0.0  1.0  0.0 


UC  E21 

0.C 


Using 

the  numerical  values 

for  the 

hydrodynamic 

coefficients 

given  in 

Appendix  C 

and  letting 

UC  still  be 

variable,  the 

constants 

of  the  A and 

B matrices 

ar  e 

All 

= -1.726 

-3 

10 

A 1 2 

= -0. 7062 

A 1 3 

= C. 01289 

A 1 4 

= -1.728 

-3 

10 

A21 

* 1.684 

-5 

10 

A22 

= -6.365 

-3 

10 

A23 

= 1.884 

-5 

10 

/ 

A24 

= -2.5 22 

-3 

10 

17 


B 1 1 

= -6.666 

-4 

10 

B 1 2 

= -3.871 

-4 

10 

B2  1 

= -1.465 

-5 

10 

E 22 

= 3.19C 

-6 

10 

C.  V AL IEATICN  OF  LINEAR  MODEL 

The  objective  of  this  section  is  to  compare  the  dynamics 
of  the  standard  model  with  the  developed  linear  model. 

In  crder  to  compare  both  models,  they  should  be  in  the 
same  initial  state,  i.e.  besides  the  identical  initial 
conditions  tcth  models  have  to  be  " in  trim  ".  One 
linearizing  assumption  was  that  the  model  will  be  in  trim  at 
all  times.  Therefore  the  standard  model  was  brought  into 
"neutral  conditions"  for  the  given  test  speeds,  in  order  to 
avoid  additional  forcing  terms.  This  procedure  will  be 
described  explicitly  in  a later  chapter. 

Any  total  system  response  can  be  viewed  as  having  two 
components:  forced  and  free.  The  forced  component  includes 
the  complex  frequencies  of  the  forcing  functions,  the  free 
component  the  complex  or  natural  frequencies  of  the  system. 
Both  response  components  were  checked  via  simulation. 
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1. 


Initial  condition  response 

It  has  expected  that  for  small  perturbations  the 
deviations  between  both  models  should  be  small.  Therefore 
initial  conditions  of  2.5°  in  pitch  where  tested  first. 
The  initial  value  of  the  second  variable  LZDOT  was  defined 
as  -UC*sin  (initial  pitch),  based  on  the  auxiliary  equation 
for  depth  change. 

lest  runs  over  400  sec  in  the  speed  range  3-15 
icncts  were  performed  simultaneously  for  both  models. 
Table  01  shows  the  max.  differences  between  the  model 
responses,  rig.  2-11  are  a representative  selection  of  the 
depth  change  and  the  pitch  behavior.  In  each  figure  curve  1 


Figure  2 - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 2.5  SPEED  = 3 KN 
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PITCH 


TIME  - 80  SEC  PER  INCH 

Figure  3 - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 2.5  °.  SPEED  = 3 KN 


DEPTH  CHANGE  - .4  FT/SEC  PER  INCH 


r 


TIME  - 80  SEC  PER  INCH 

Figure  4 - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 2.5  SPEED  = 7 KN 


TIME  - 80  SEC  PER  INCH 

Figure  5 - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 2.5  °,  SPEED  = 7 KN 
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i-ov  2 >c:  ,v”  tc.:: 

• KlO  1 

TIME  - 80  SEC  PER  INCH 

Figure  6 - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 2.5  SPEED  = 9 KN 
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TIME  - 80  SEC  PER  INCH 


Figure  7 - INITIAL  CONDITION 
INITIAL  PITCH  = 2.5  SPEED 


RESPONSE 
= 9 KN 
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DEPTH  CHANGE 


r " 


v i r r~ 

: 000  :a.  oc  24.0 

cue  1 

TIME  - 80  SEC  PER  INCH 

Figure  8 - INITIAL  CONDITION 
INITIAL  PITCH  = 2.5  SPEED 


RESPONSE 
= 11  KN 
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mo  1 

TIME  - 80  SEC  PER  INCH 

Figure  9 - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 2.5  SPEED  = 11  KN 
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DEPTH  CHANGE 


TIME  - 80  SEC  PER  INCH 

Figure  10  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 2.5  SPEED  = 15  KN 
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PITCH  - 2°  FER  INCH 
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a 
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TIME  - 80  SEC  PER  INCH 


Figure  11  - INITIAL  CONDITION 
INITIAL  PITCH  = 2.5  SPEED 


1 ( 


RESPONSE 
15  KN 


30 


As  one  can  readily  observe,  all  deviations  are  small 
for  this  initial  condition,  which  indicates  that  the 
dynamics  are  nearly  identical  for  small  per t jr Dat i o ns . 

The  maximum  pitch  angle  expected  in  normal 
operations  is  limited  to  about  45  °.  Therefore  this  initial 
condition  was  simulated  as  well.  As  for  the  initial 
condition  of  2.5°  the  max.  deviations  are  summarized  in 
Table  02.  In  Fig.  12-23  curve  1 represents  the  non-linear, 
curve  2 the  linear  model. 


Ihe  second  set  of  initial  conditions,  which 
represents  rather  large  perturbations,  still  leads  to  very 
similar  dynamic  behavior,  but  the  deviations  increased 
substantially.  This  was  expected  as  the  angle  approximation 

sin  0=0 


is  rather  crude  for  angles  of  this  magnitude.  In  addition 
to  that  the  constant  speed  assumption  is  not  as  valid  as  for 
IC  = 2.5°.  For  both  sets  of  initial 
observed  that  increasing  speed  tends 
deviations  between  both  trajectories. 


condition  it  is 
to  increase  the 
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Table  02  - Initial  condition  response  to  45. 


131.25  5.05  10  2 2,23 
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TIME  - 30  SEC  PER  INCH 

Figure  12  - INITIAL  CONDITION 
INITIAL  PITCH  = 45  SPEED 


-r 


RESPONSE 
3 KN 
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PITCH  - 14°  PER  INCH 
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TIME  - 80  SEC  PER  INCH 

Figure  13  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  Sp£ED  = 3 KN 
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TIME  - 80  SEC  PER  INCH 

Figure  14  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  SPEED  = 5 KN 
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Figure  15  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  °,  SPEED  = 5 KN 
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Figure  16  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  SPEED  = 7 KN 
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Figure  17  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  SPEED  = 7 KN 
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TIME  - 80  SEC  PER  INCH 

Figure  18  - INITIAL  CONDITION 
INITIAL  PITCH  = 45  °,  SPEED  = 


RESPONSE 
9 K N 
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Figure  19  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  SPEED  = 9 KN 
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Figure  20 
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Pigure  21  - INITIAL  CONDITION 
INITIAL  PITCH  = 45  SPEED 


RESPONS  E 
13  KN 
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TIME  - 80  SEC  PER  INCH 


Figure  22  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  SPEED  = 15  KN 
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TIME  - 30  SEC  PER  INCH 

Figure  23  - INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  = 45  SPEED  = 15  KN 
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2. 


Forced  response 

As  the  models  considered  are  deeply  submerged  and  in 
trim,  the  planes  exert  the  only  relevant  forces.  It  was 
considered  best  to  test  the  response  of  both  models 
(excluding  actuators)  to  sinusoidal  forcing  functions, 
because  in  the  controlled  system  the  rudder  excursions  due 
tc  depth  and  pitch  changes  are  expected  to  be  sinusoidal. 

The  following  forcing  functions  were  chosen  for  both 
planes  separately  and  three  different  speeds  (3,  9,  15 

knots)  : 

A*sin  (B*t) 

where  A = 35°,  15°,  5° 

and  E = 5. 73,  2.87  o/sec 

The  magnitude  of  the  amplitude  was  limited  tc  35°, 
because  this  is  an  approximate,  mechanical  limit. 

The  max.  deviations  are  summarized  in  Table  03-05.  Curve  1 
and  2 in  Fig.  24-69  show  the  responses  of  the  non-linear  and 
linear  model  respectively. 
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Table  03  - Speed 
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DEPTH  CHANGE  - 6 FT/SEC  PER  INCH 


r 
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Figure  24  - PORCED  RESPONSE,  3 KN 
LDB  = 35  0 SI N . ^ t 
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Figure  25  - FORCED  RESPONSE,  3 KN 
LDB  = 35  ° SI N .1  t 
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Figure  26  - FORCED  RESPONSE,  3 KN 
LDS  = 5 °SIN  .1  t 
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Figure  27  - FORCED  RESPONSE,  3 KN 
LDS  = 5 0 SI N . 1 t 
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TIME  - 80  SEC  PER  INCH 

Figure  28  - FORCED  RESPONSE,  3 KN 
LDS  = 15  0 SI N . 1 t 
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= 15  0 SI N .1  t 
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Figure  30  - PORCED  RESPONSE,  3 K N 
LDB  = 15  °SIN  .05  t 
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Pigure  31  - FORCED  RESPONSE, 
LDB  = 15  °SIN  .05  t 
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Figure  32  - FORCED  RESPONSE,  3 KN 
LDS  = 15  °SIN  .05  t 
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TIME  - 80  SEC  PER  INCH 

Figure  33  - FORCED  RESPONSE,  3 KN 
LDS  = 15  0 SI N .05  t 
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Table  04  - Speed 
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Figure  34  - FORCED  RESPONSE,  9 KN 
LDB  = 15  0 SI N . 1 t 
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TIME  - 80  SEC  PER  INCH 

Pigure  35  - FORCED  RESPONSE,  9 KN 
LDB  = 15  °SIN  .1  t 
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DEPTH  CHANGE  - 6 FT/SEC  PER  INCH 
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TIME  - 80  SEC  PER  INCH 

Figure  36  - FORCED  RESPONSE,  9 KN 
LDS  = 5 0 S I N . 1 t 
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Figure  37  - FORCED  RESPONSE,  9 KN 
LDS  = 5 °SI N . 1 t 
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Figure  38  - FORCED  RESPONSE,  9 KN 
LDS  = 15  °SIN  . 1 t 
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PORCED  RESPONSE, 
= 35  0 SI N . 1 t 
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Figure  42  - PORCED  RESPONSE,  9 KN 
LDB  = 5 0 S I N .05  t 
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Figure  44  - 
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= 15  °SI N .05  t 
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Figure  47  - FORCED  RESPONSE,  9 KN 
LDB  = 35  0 SI N .05  t 
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Figure  49  - FORCED  RESPONSE, 
LDS  = 5 °SIN  .05  t 
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Figure  51  - FORCED  RESPONSE , 
LDS  = 15  0 SI N .05  t 
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Figure  52  - FORCED  RESPONSE,  9 KN 
LDS  = 35  °SIN  .05  t 
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Figure  53  - FORCED  RESPONSE,  9 KN 
LDS  = 35  °SIN  .05  t 
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Figure  54  - FORCED  RESPONSE,  15  KN 
LDB  = 35  ° SI N . 1 t 
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Pigure  55  - 
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FORCED  RESPONSE,  15  KN 
= 35  0 SI N . 1 t 
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Figure  56  - 
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FORCED  RESPONSE*’  15  KN 
= 5 °SI  N . 1 t 
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Figure  58  - FORCED  RESPONSE,  15  KN 
LDB  = 15  0 S I N . 1 t 
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Figure  59  - FORCED  RESPONSE,  15  KN 
LDB  = 15  0 ST N . 1 t 
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Figure  60  - FORCED  RESPONSE,  15  KN 
LDB  = 35  0 SIN  . 1 t 
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Figure  61  - FORCED  RESPONSE,  15  KN 
LD8  = 35  ° SI N . 1 t 
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Figure  62  - FORCED  RESPONSE,  15  KN 
LDB  = 5 °SI N .05  t 
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Pigure  63  - FORCED  RESPONSE,  15  K N 
LDB  = 5 0 SI N .05  t 
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Figure  64  - PORCED  RESPONSE,  15  KN 
LDB  = 15  °SIN  .05  t 
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Figure  65  - FORCED  RESPONSE,  15  KN 
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Figure  66  - FORCED  RESPONSE,  15  KN 
LDS  = 5 °SI N .05  t 
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Figure  67  - FORCED  RESPONSE,  15  KN 
LDS  = 5 0 SI N .05  t 
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Figure  68  - FORCED  RESPONSE,  15  K N 
LDS  = 15  USIN  .05  t 
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PITCH  - 14°  PER  INCH 


Figure  69  - FORCED  RESPONSE,  15  KN 
LDS  = 15  0 SI N .05  t 
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3 knots 


* 


The  response  to  the  sternplane  showed  an  increasing 
deviation  in  pitch  and  depth  change  with  increasing 
amplitude.  With  decreasing  frequency  the  gain  was 
increased.  The  percent  deviation  stayed  about  the  same. 

The  response  to  the  fairwater  plane  shows  the  same 
behavior  except  that  the  gain  ratio  D5/DB  =3.5  for  pitch 
and  1.6  for  depth  change.  The  absolute  magnitude  of  all 
deviations  is  considered  negligibly  small. 

This  can  te  expected,  because  the  pitch  involved  is 
relatively  small  and  the  speed  is  about  constant  (max. 
decrease  in  speed  is  .38  kn  for  35°  plane  deflection) . 

* 3 kncts 

The  speed  decreases  substantially^  (up  to  2.2  kn)  for 
large  plane  angles,  which  causes  bigger  deviations  in  pitch 
and  depth  change  (up  to  12.7°). 

But  it  cculd  be  observed  that  the  linearized  model  was  still 
a good  approximation  for  small  perturbations. 

* 15  knots 

At  this  speed  the  decrease  of  'J  was  even  bigger  ( ip 
to  32%  at  35°  plane  deflection),  whicn  resulted  in  iar:  r 
deviations  in  both  variables.  F or  small  perturba*i 
approximation  is  still  very  good. 

Thus  it  has  been  shown  that: 

- Approximation  by  linear  model  is  vi.. 
perturbations  at  all  speeds. 

- The  dynamics  of  noth  models  ar*;  > > t.  •* 

In  addition  it  has  been 
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linearized  mcdel  is  still  valid  for  large  perturbations 
applied  ever  a short  period  of  time  (initial  condition 
response) . When  large  plane  angles  were  applied  over  a long 

period,  the  speed  of  the  standard  model  decreased 

s 

substantially,  which  made  the  constant  speed  assumption 
invalid. 


3.  Actuator  model 

The  linearized  model  does  not  include  the  dynamics 
of  the  plane  actuators,  which  are  force  and  moment 
producers.  Including  the  actuators  would  increase  the 
complexity  of  the  system.  The  actuator  dynamics  may  be 
ignored  in  the  analysis  and  initial  design  phase,  if  and 
only  if  their  dynamics  are  '*  fast  " compared  with  the  system 
dynamics . 


From  our  own  experience,  we  Know  that  the  response 
of  the  hydraulic  systems  to  a unit  step  input  looks  like  an 
exponential  function  of  the  form: 


-kt 

( 1 - e ) 

which  has  the  Laplace  transform  of 

1 1 

m — 

S (S  + k) 

Thus  the  actuator  dynamics  will  be  represented  by: 


(s*k) 
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oL  represents  the  inverse  of  the  time  constant, 
which  has  to  be  determined.  As  the  rate  of  the  rudder 
deflection  depends  on  the  magnitude  of  the  desired  angle  the 
maximum  rate  limit  is  determined  by  the  mechanical  limits  of 
the  rudder,  which  are  assumed  to  be  ± 35  ° for  this  model. 
It  was  assumed  that  the  maximum  deflection  is  reached  in  5 
time  constants.  As  the  needed  time  is  about  3 to  3.5  sec, 
the  time  constant  was  determined  to  be  2/3  sec. 

The  actuator  time  constant  is  fast  compared  to  those 
of  the  system.  Therefore  the  actuators  will  be  neglected  in 
the  design  of  the  compensators,  but  will  be  included  in  the 
simulation  of  the  compensated  system. 
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III.  DESIGN  SPECIFICATIONS 


The  objective  is  to  design  an  automatic  controller  for 
maneuvering  in  the  vertical  plane,  i.e.  depth  and  pitch 
control.  The  submarine  is  considered  deeply  submerged  and 
therefore  free  from  all  external  disturbances  like  surface-, 
bottom-,  and  wall-effects.  The  dynamics  for  a depth  change 
include  the  depth  and  pitch  dynamics.  The  depth  response  tc 
an  ordered  depth  change  should  basicly  look  like  a second 
order  overdamped  or  highly  damped  system  response.  The  pitch 
shall  be  kept  as  close  as  possible  to  the  ordered  pitch, 
which  under  regular  conditions  will  be  zero.  This  submarine 
has  no  inertial  guidance  system  (as  for  example  the  German 
coastal  subnarines) . Bate  information  is  not  available  and 
the  only  states  to  be  used  as  feedback  are  depth,  pitch,  and 
speed.  £ue  to  this  limited  instrumentation  the  controller 
will  have  to  use  cascaded  filters. 

* Time  reguirements. 

Depth  changes  at  even  keel  for  speeds 

- < 9 kn  10  ft  in  < 120  sec 

100  ft  in  < 240  sec 

- > 9 kn  10  ft  in  < 60  sec 

100  ft  in  < 100  sec 
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* 


Overshoot  requirements 


I 


For  depth  changes 

* 

< 1QG  ft  < 5 X 

> 100  ft  < 5 ft 

* Pitch  deviations 

Always  less  than  ± 2 0 from  ordered  pitch. 

* Mechanical  constraints 

- plane  angle  limits  according  to  diagram 


Speed  in  kn 


- maximum  possible  pitch  < 45  5 
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IV.  DESIGN 


A.  TRANSFER  FUNCTION 


The  design  approach  chosen  for  this  thesis  requires  the 
system  description  by  the  transfer  function  matrix.  Matrix 
equation  (7)  is  the  state  variable  representation  cf  the 
system.  The  signal  flowgraph  equivalent  for  this  system  is 
given  below.  An  additional  integration  is  included,  because 
the  depth  is  a desired  output. 
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The  input-output  relations  of  interest  are  DEPTH/DS, 
DEETH/DB , PITCH/DS,  and  PITCH/DB,  because  depth  and  pitch 
will  be  the  measurable  quantities  and  will  be  used  for  the 
control. 

Applying  Mason's  gain  rule  the  input-output  relations 
have  the  form 

2 

Y (s)  N2*s  ♦ N 1 *s  + NO 

= - 3 2 

X (s)  B4*s  ♦ D3*s  + D2*s  ♦ D1*s  ♦ DO  (8) 

The  coefficients  for  equation  (8)  are: 


ZDCT/DS 

• 

• 

N2 

= 

2 

E 1 1*UC 

N 1 

s 

3 

( A 22*B  1 1 - A 1 2*32  1)  *0C 

NO 

s 

2 2 2 
(E2 1*  (A  13  + A14*(JC  ) - B11*(A23*0C  ♦ A24) ) *UC 

D4 

* 
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D2 
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3 

2 2 

All* (A23*UC  ♦ A24)*0C  - A21*UC*(A13  ♦ A14*UC  ) 

DO 

= 

o 

• 

o 

ZDOT/DB 

• 

• 

N2 

3 

2 

E 12*0C 

N 1 

= 

3 

- (A22*B12  - A 1 2*3  22) *0C 

NO 

= 

2 2 2 
( E 22* (A  1 3 ♦ A 1 4 * UC  ) - B12*(A23*UC  ♦ A24))*0C 

D4 

3 

1 

D3 

3 

-(All  ♦ A22)<UC 
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02  = 

2 2 2 
A11*A22*UC  - ( A 2 3*UC  ♦ A24)  - A12*A21*UC 

D 1 = 

2 2 
All*  ( A23*UC  + A24)*0C  - A21*UC*(A13  + A14*0C  ) 

II 

o 

Q 

0.0 

PITCH/DS 

• 

• 

HI  = 

2 

£21* UC 

HO  = 

3 

( A2  1*B1  1 - A 1 1*B2  1 ) *UC 

03  = 

1 

02  = 

-(All  «•  A22) *UC 

01  = 

2 2 2 
A 1 1*A22*UC  - ( A23*UC  ♦ A24)  - A12*A21*0C 

DO  = 

2 2 
All* (A23*UC  ♦ A24) *UC  - A21*UC*(A13  ♦ A14*UC  ) 

PITCH/DB 

• 

HI  = 

2 

E22*UC 

HO  = 

3 

( A2 1*B1 2 -A  1 1*B22) *0C 

D3  = 

1 

D2  = 

-(All  + A22)  *UC 

D 1 = 

2 2 2 
A 1 1 *A  22  *UC  - (A23*UC  + A24)  - A12*A21*0C 

DO  = 

2 2 
A11*(A23*0C  + A24)  *UC  - A21*0C*(A13  ♦ A14*0C  ) 

Table  06  through  10  show  the  root-locations  for  the 
speed  range  1 Jen  - 15  kn.  The  characteristic  roots  move 
closer  to  the  origin  and  the  damping  reduces  with  decreasing 
speed.  This  indicates  that  the  overall  response  cf  the 
uncompensated  submarine  will  be  much  slower  for  3 kn  than 
for  9 kn  cr  15  kn. 
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Table  06  - Characteristic  roots 


Speed 

Root 

Complex 

roots 

1 

-2 

-0.2774  10 

-0.5452 

-2 

10 

± 

j 

0.4978 

-1 

10 

2 

-2 

-0.5650  10 

-0. 1085 

-1 

10 

± 

j 

0.484  1 

-1 

10 

3 

-2 

-0.8768  10 

-0.1613 

-1 

10 

± 

j 

0.4604 

-1 

10 

4 

- 1 

-0.1235  10 

-0.2114 

-1 

10 

± 

j 

094245 

-1 

10 

5 

- 1 

-0.1705  10 

-0.2563 

-1 

10 

i 

j 

0.3716 

-1 

10 

6 

-1 

-0.2527  10 

-0.2835 

-1 

10 

± 

j 

C.  2908 

-1 

10 

7 

-1 

-0.4872  10 

-0.2347 

-1 

10 

± 

j 

0.2116 

-1 

10 

8 

-1 

-0.7068  10 

-0.1933 

-1 

10 

t 

j 

0.2032 

-1 

10 

9 

-1 

-0.8812  10 

-0. 1744 

-1 

10 

± 

j 

0.2014 

-1 

10 

10 

-0. 1038 

-0.  1643 

-1 

10 

± 

j 

0.1999 

-1 

10 

1 1 

-0.1  186 

-0.1 586 

-1 

10 

t 

j 

0,1982 

-1 

10 

12 

-0. 1 328 

-0.1557 

-1 

10 

t 

4 

J 

0.  1963 

-1 

10 

13 

-0. 1467 

-0. 1546 

-1 

10 

± 

j 

0.1940 

-1 

10 

14 

-0. 1603 

-0.1549 

-1 

10 

± 

j 

0.1915 

-1 

10 

15 

-0. 1738 

-0.1562 

-1 

10 

± 

j 

0.1887 

-1 

10 

J 
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Table  07  - Zeros  of  Pitch/DS 


Speed 


Gain 

Hoot 

-4 

-0.4184  10 

-2 

-0.4370  10 

-3 

-0.1674  10 

-2 

-0.8739  10 

-3 

-0.3766  10 

-1 

-0.1311  10 

-3 

-0.6675  10 

-1 

-0.1745  10 

-2 

-G..  1044  10 

-1 

-0.2182  10 

-2 

-0.1503  10 

-1 

-0.2619  10 

-2 

-0.2047  10 

-1 

-0.3056  10 

-2 

-0.2674  10 

-1 

-0.3493  10 

-2 

-0.3385  10 

-1 

-0.3929  10 

-2 

-0.4179  10 

-1 

-0.4367  10 

-2 

-0.5057  10 

-1 

-0.4804  10 

-2 

-0.6013  10 

-1 

-0.5238  10 

-2 

-0.7058  10 

-1 

-0.5675  10 

-2 

-0.8187  10 

-1 

-0.6112  10 

-2 

-C.9400  10 

-1 

-0.6549  10 

Table  C8  - Zeros  of  Pitch/DB 


Speed 

Sain 

Hoot 

1 

-5 

0.9111  10 

-3 

0.9434  10 

2 

-4 

0.3644  10 

-2 

0.1887  10 

3 

-4 

0.8200  10 

-2 

0.2831  10 

4 

-3 

0.1453  10 

-2 

0.3768  10 

5 

-3 

0.2272  10 

-2 

0.4713  10 

6 

-3 

0.3274  10 

-2 

0.5654  10 

7 

-3 

0.4457  10 

-2 

0.6599  10 

3 

-3 

0.5822  10 

-2 

0.7542  10 

9 

-3 

0.7370  10 

-2 

0.8484  10 

10 

-3 

0.9100  10 

-2 

0.9428  10 

1 1 

-2 

0. 1 10  1 10 

12 

-2 

0.1309  10 

-1 

0.1131  10 

13 

-2 

0.1537  10 

-1 

0.1225  10 

14 

-2 

0.1783  10 

-1 

0.1319  10 

15 

-2 

0.2047  10 

-1 

0.1414  10 

Table  09  - Zeros  of  Depth/DS 


Speed 

Gain 

Root 

■ ■.  — 

Root 

1 

-2 

-0.1904  10 

-2  -1 
-0.7732  10  ± j 0.5083  10 

2 

-2 

-0.7618  10 

-1  - 1 
-0.1546  10  ± j 0.4378  10 

3 

-1 

-0.1714  10 

_ 

-1  -1 

-0.2320  10  ± j 0.2841  10 

4 

-1 

-0.3036  10 

-1 

0.5803  10 

-2 

-0.3740  10 

5 

-1 

-0.474S  10 

-1 

0.9089  10 

-1 

-0. 1366  10 

6 

-0.6843  10 

0.1183 

- 1 

-0.2557  10 

7 

-1 

-0.9316  10 

0. 1438 

-1 

-0.3567  10 

8 

-0. 1217 

0. 1685 

-1 

-0.4489  10 

S 

-0.1541 

0. 1926 

-1 

-0.5356  10 

10 

-C. 1 S02 

0.2165 

-1 

-0.6190  10 

1 1 

-0.2302 

0.2400 

-1 

-0.7001  10 

12 

-C.2737 

0.2633 

-1 

-0.7790  10 

13 

-C.3213 

0.2866 

- 1 

-0.8572  10 

14 

-0.3726 

0.3097 

-1 

-0.9343  10 

15 

-094278 

0.3329 

-0.1011 
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Table  10  - Zeros  of  Depth/DB 


-0.1106 

-2 

10 

-0.4422 

-2 

10 

-0.995C 

-2 

10 

-0.  1764 

-1 

10 

-0.2757 

-1 

10 

-0.3972 

-1 

10 

-0.54C8 

-1 

10 

-0.7C65 

-1 

10 

-0 .8944 

-1 

10 

-0.1030 

-1 

10  ± 

j 

0.4792 

- 1 

10 

-0.2059 

- 1 

10  ± 

j 

0.4404 

-1 

10 

-0. 3089 

-1 

10  ± 

j 

0.3665 

- 1 

10 

-0.4112 

-1 

10  ± 

j 

0.2269 

- 1 

10 

-0.2784  10 


-0.1853  10 


-0.1359  10 


-0.1020  10 


-0.7620  10 


-C.  1 104 


-0.2003 


-0.5510  10 


-0.  1336 

-0.2227 

-2 

-0.3718  10 

-C.  1589 

-0. 2447 

-2 

-0.2156  10 

-0.  1865 

-0.2667 

-3 

-0.7430  10 

-0. 2 163 

-0.2886 

-3 

0.5368  10 

-0 . 2484 


-0.3088 


0.1734  10 


B.  STEADY-STATE  DECOUPLING 


The  derived  model  represents  a linear,  multivariable 
system.  In  order  to  allow  the  application  of  existing 
single-loop  technigues,  such  as  Nyguist-Bode-Nichol 1 s 
methods  and  Root-Locus  design,  the  equations  must  be 
decoupled.  Decoupling  requires  the  system  to  be 
character ize d by  a non-singular,  diagonal  transfer  function 
matrix.  When  linear  state  variable  feedback  is  applied,  one 
necessary  condition  according  to  Wolovich  (Ref.  12)  is  that 
a system  characterized  by  a (n  * m)  transfer  function  matrix 
may  not  ijav*  poles  at  the  origin.  The  developed  linear 
system  contains  two  transfer  functions  with  such  poles. 

Ref.  4 develops  another  approach  which  decouples  the 
steady-state  only.  This  approach  uses  classical  cascade 
compensation  and  allows  the  precluded  poles  at  the  origin. 
Actually,  these  poles  are  used  tor  the  decoupling  of  linear, 
multivariable  systems. 

A steady-state  decoupled  system  is  a system  in  which 
changes  in  each  input  are  reflected  in  a corresponding 
output  and  only  that  output,  when  steady-state  is  reached. 
Thus  mutual  interactions  are  allowed  during  the  transient 
period,  tut  only  during  this  period. 

Using  cascade  compensation  and  a diagonal  compensator 
matrix 
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the  model  configuration  becomes: 


By  theorem  2.2  of  Ref.  4 the  system  is  steady-state 
decoupled  if  and  only  if 

(k-1) 

1.  lim  1/  s * (I  + G G ) /det  (I  + G G ) = 0 (9) 

4-°  p c 12  pc 

and 

(k-  1) 

2.  lim  1/  s * (I  + G G ) /det(I  + G G ) = 0 (10) 

s-*  o p c 2 1 pc 
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Since 


G G 
P c 


g g 9 9 

p 1 1 ell  p 1 2 c22 


9 9 9 9 

p21  c)1  p 22  c22 


we  have 


det  (I*G  G ) = 1*g  g *g  g + 
pc  pi  1 cl  1 p22c22 

9 9 9 9 " 

p 11  p22  cl  1 c 22 

9 9 9 9 

p 12  p2 1 c 1 1 c22 


and  cofactors 


(I  + G G j 
p c 12 

(I  + G G ) 
p c 2 1 


9 9 

p2 1 ell 

9 9 

p 1 2 c2 2 


(11) 


(12) 

(13) 


K and  k are  defined  according  to 
1 2 

*3 

(input  (t) ) = 1/  s 

where  the  inputs  are  constants,  steps, 
arbitrary  amplitude. 


ramps  etc. , 


with 


By  substituting  (11)/  (12),  and  (13)  into  (9)  and 
(10), and  assuming  a step  input  for  depth  and  constant  pitch, 
we  have  the  two  necessary  and  sufficient  conditions  for 
steady-state  decoupling  : 


lim 

9 9 

/ D = 0 

(14) 

i-*o 

p 2 1 ell 

lim 

s*g  g 

o 

II 

Q 

\ 

(15) 

s-»o 

12  22 
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where 


D = det  (I+G  G ) 
F c 


All  g are  known.  Thus  the  design  for  steady-state 
F 

decoupling  is  the  determination  of  g and  g such  that 

c 1 1 c22 

(14)  and  (15)  are  satisfied. 


Although  the  locations  of  the  poles  and  zeros  are 
dependent  on  the  speed  their  number  is  independent. 
Therefore  the  poles  will  be  called 

p m - 1,2,3... 

i jm 

and  the  zeros 


z m - 1,2,3... 

i jm 

th 

where  ij  denotes  the  element  of  the  matrix  and  m the  m 
pole  and  zero  of  the  element. * 
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where 


r = (s+p  ) (s+p  ) (s+p  ) 

0 111  112  113 

When  these  transfer  functions  are  substit 
equations  (14)  and  (15),  both  limits  go  to  zero 
speeds. 

Thus  conditions  (1)  and  (2)  are  satisfied  fox  the 
inputs. 

1 • Design  of  closed-loop  system 

The  previous  section  resulted  in  the  dec 
the  steady-state  of  the  system.  However,  one  must 
that : 

1.  the  result  does  not  guarantee  stability. 

2.  steady-state  decoupling  is  only  aeaningf 
the  closed-loop  system  is  stable. 

Thus  it  is  necessary  to  consider  the  stabil 
clcsed-locp  system  after  the  steady-state  aecou 
been  achieved. 


Hef.4  investigates 
and  multivariable  syste 
clcsed-lccp  characteristic 
multivariable  systems  by 
method.  The  primary  method 
design. 


a connection 
ms  by  prope 
equation.  It 
using  any 
chosen  will 


between  s 
rly  factor 
allows  the 
suitable  s 
be  the 


uted  into 
for  all 

specified 


oupling  of 
realize, 

ul, when 

ity  of  the 
pling  has 

ingle-loop 
izing  the 
design  of 
i ngle-loop 
roct -locus 
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2.  Stability  criterion 


Ref.  13  and  14  prove  that  the  stability  of  tnis 
multivariable  system  is  determined  by  the  zeros  of  N^(s) 

and  N (s) , where 
2 


N (s)/D  (s)  = det  (I  ♦ G (s)  *G  (s)) 
11  pc 

and 

N (s)  = A c (s)  *AP  (S)  /D  (s) 

2 1 


(16) 


(17) 


N^(s)/D^(s)  is  in  irreducible  form,  i.e.  all  common  factors 

are  cancelled.  A c (s)  represents  the  characteristic 
polynomial  cf  the  transfer  function  matrix  G (s)  and  Af(3) 


c 

represents  the  polynomial  of  the  transfer  function  matrix 

G (s) . The  characteristic  polynomial  cf  the  transfer 
P 

function  is  defined  as  the  least  common  denominator  of  all 
miners. 


However  Ref. 4 devises  a method  by  which  it  is 
necessary  to  check  equation  (16)  alone  for  stability,  if: 

1.  cancellations  are  selected  systematically  by 
using  equation  (4.5)  Ref.  4. 

2.  poles  of  G are  carefully  selected,  which  can 

c 

be  taken  care  of  in  the  process  of  the  design. 


113 


Thus 


det  (I  ♦ G G ) = 0 (18) 

P c 

represents  the  characteristic  equation  of  the  multivariable 
system. 

Per  the  system  under  consideration  equation  (18) 

becomes: 


det  (I  + G G ) = 1 + g g ♦ g g ♦ det  (G  )g  g 

p c p 1 1 ell  pz2  c22  p cl  1 c22 


which  can  be  factored 


det  (I  + G G ) = (1  + g g ) (1+G  g ) 
pc  p 1 1 cl  1 eq  c22 


where 


G 

eq 


9 __  0 


detG  *g  /g  )/(1  + g g ) 

p cl  1 p22  pi  1 cl  1 


(19) 


Ey  cancellation  of  the  common  roots  the  equation 
determining  the  stability  of  the  system  becomes 

1 ♦ G g * 0 . (20) 

eq  c22 


Equation  (20)  still  contains  both  g and  g as 

c 1 1 c22 

unknown  functions.  It  is  possible  for  example  to  choose  g 

cl  1 

arbitrarily.  In  this  case  the  only  unknown  left  to  be 
designed  is  g , which  means  the  design  is  reduced  to  a 


single-lccp  case.  But  if  g has  not  been  chosen  Droperly, 

cl  1 

G may  beccme  very  unstable.  This  can  make  the  design  of 
eg 
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g very  difficult.  Thus  it  is  preferable  to  have 

c22 

guidelines  in  choosing  g in  order  to  get  a reasonable 

cl  1 

pole-zero  pattern  for  G , which  will  make  the  design  of 

eq 

g much  easier. 
c22 


3*  Cesign  Guidelines 

The  roots  of  equation  (19)  are  determined  by  the 
following  expressions: 

1 . G ^ = 


2.  G = 

1 


where 


G = G /G  (21) 

eq  12 


Then 


g + det  (G  ) g 
p22  p ell 


1 ♦ g g 

P 1 1 ell 


det (I  ♦ G G ) 
p c 


G g 
2 c22 


As  the  design  is  concerned  with  the  poles  and  zeros 

of  G they  must  be  identified.  They  can  be  found  by 
eq 

considering  the  functions  G and  G . From  equation  (21)  it 

1 2 

can  be  seen,  that  the  zeros  of  G are  determined  by: 

eq 


Z = Z ♦ P - (P  n P ) 

Geq  G 1 G2  G2  G1 


(22) 


115 


(23) 


F = Z ♦ P - (P  n P ) 

Geq  G2  G 1 G2  G1 


Poles  and  zeros  of  G and  G are  dependent  on  the  function 

1 2 


g according  to: 
c 1 1 


1 * d€t(G  )*g  / g = 0 

p cl  1 p2 2 


(24) 


1 ♦ g g =0 
F 1 1 ell 


(25) 


Therefore  the  design  will  proceed  as  follows: 


1.  Design  g to  achieve  a reasonable  pole-zero  pattern 
c 1 1 

for  G 

eg 


a.)  Prepare  root-locus  studies  for  equation  (24)  and 

(25)  , where  g = f (K  ,s)  . K is  a real  parameter 
cl  1 1 1 

positive  cr  negative.  The  poles  and  zeros  of  g 


a re 


cl  1 


determined  by 


aa.)  number  of  free  integrators  needed  to  decouple 
the  system. 

at.)  the  needs  of  compensation,  which  may  arise, 
due  to  desired  root  locations. 


b.)  From  root-locus  studies  choose  the  parameter  K ^ , 

which  fixes  g . This  will  be  an  iterative  process  as 
cl  1 

both  rcct-lccus  studies  in  combination  with  equations 

(22)  and  (23)  determine  the  final  pole-zero  pattern  of 

G . 
eg 
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2.  Design  of  g in  order  to  meet  the  system 

c22 

specification.  As  G is  known  equation  (20),  i.e. 

eq 


1 ♦ G g =0 

eq  c2  2 

can  be  studied  via  root-locus,  where  g = f (K  , s) . The 

c2  2 2 

criteria  which  determine  f (K  ,s)  are  the  same  as  mentioned 

2 

above  for  f (K^ ,s)  . 


3.  With  the  proper  choice  of 

a. )  system  stability  is  guaranteed. 

b. )  the  dynamics  of  the  system  are  fixed. 

c. )  the  diagonal  compensator  is  determined. 

4.  The  design  is  completed.  Now  simulation  is  required  to 

check  whether  the  design  specifications  have  been  met.  If 

the  specifications  have  not  been  met,  a redesign  of 

compensator  g or  even  g may  be  necessary.  But  every 
c22  ell 

trial  provides  some  insight  and  helps  with  the  next  trial. 


4 • Eoot-locus  design 

Fcllcwing  the  design  guide  lines  the  first  step  is  a 

roct-locus  study  for  the  equations  (24)  and  (25) . As  shown 

in  II. B no  free  integrators  for  g and  g are  required 

ell  c22 

for  the  specified  inputs. 


The  speed  range  of  interest  extends  from  3 kn  to  15 


\ 

1 17 


A 


kn.  As  th€  root  locations  of  the  system  change  with  varying 
speed,  it  is  not  certain  whether  one  compensator  set  will 
cover  the  whole  speed  range.  It  seems  reasonable  to  design 
for  the  medium  speed  of  9 kn.  Afterwards  it  can  be  tested 
whether  this  compensator  set  is  adequate  for  the  whole  speed 
range  and  whether  the  variations  due  to  speed  can  be  taken 
care  of  by  either  gain  variations  or  other  means.  It  may 
turn  out  that  different  compensators  are  required  tc  meet 
the  design  specifications. 

a.)  Design  of  g 

c 1 1 


The  rcct-lcci  for  1*g  g =0  where  g =K  are 

ell  pll  c 11  1 

shewn  in  Fig.  70  K = negative  and  Fig.  71  K = oositive. 

1 21 

K = positive  is  clearly  undesirable,  because  there  will  be 
one  branch  that  extends  along  the  positive  real  axis  tc  ♦ 
and  will  produce  a pole  on  the  positive  real  axis  for  G 

eg 


Ibe  root-loci  for  1 ♦ det  (G  ) *g  /g  =0  are 

p ell  p 22 


shewn  in  Fig.  72  K = negative  and  Fig.  73  K = 

For  the  same  reason  as  above  K has  to  be  negative. 

1 


positive. 


From  the  root-loci  for  X = negative  it  is  obvious 

1 

that  further  compensation  is  needed  in  order  to  achieve 

reasonable  root  locations.  The  following  compensator  was 
chcsen 


2 2 

g =K  (s  ♦ 0.4)  /(s  ♦ 4.0) 
c 1 1 1 
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.1  UNITS  PER  INCH 


Figure  70  - ROOT  LOCUS  1+GP11*GC11  = 0 
SPEED  = 9 KN,  K1  = NEG  . 
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-*» 


Figure 


.1  UNITS  PER  INCH 

71  - ROOT  LOCUS  1 ♦G? 1 1 *GC 1 1 = 0 
SPEED  = 9 KN,  K1  = POS. 
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Figure  72 


.1  UNITS  PER  INCH 


ROOT  LOCUS  1 + DET  (GP) /GP22*GC1  1 = 0 
SPEED  = 9 KN,  K 1 = NEG. 
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.1  UNITS  PER  INCH 


Pigure  73  - ROOT  LOCUS  1 + DET  (GP) /GP22*GC1 1 = 0 
SPEED  = 9 KNr  K1  = POS. 


122 


This  compensation  resulted  in  Fig.  74  for 

1*c  g =0  and  Fig.  75  for  1+det  (G  Jg  g =0.  The 
'ell  p 1 1 p c 1 1 p 1 1 

rocts  of  Fig.  74  represent  part  of  the  poles  of  G .By 

eg 

means  of  the  compensation  all  roots  were  constrained  tc  the 

stable  region.  The  roots  of  Fig.  75  will  form  the  zeros  of 

G . Although  this  compensation  did  not  pull  the  unstable 
eg 

branches  considerably  to  the  left  half  plane,  it  does  not 

mean  that  the  system  will  not  be  well  behaved,  because  the 

system  behavior  will  in  the  end  be  determined  by  the  poles 

of  G and  g 

eg  c22 

As  Bef.  4 in  eguations  (6-33)  points  out,  the  poles 

and  zeros  of  G are  determined  as  follows: 
eg 


Poles: 

P 

Z +P  - 

(P  ^ P 

Geg 

G 1 G2 

G2  G 1 

Zeros : 

Z 

Z +P  - 

(P  n P 

Geg 

G2  G 1 

G2  G 1 

P 

P 

♦ P 

G 1 

gpll 

gc  1 1 

Z 

G 1 


P 

G 2 


P 

G2 


{roots  from  foot-locus  1+g  g =0} 

p 1 1 ell 


P +P(detG  ) g - (P  a PfdetG  )g  ) 
gp 22  pell  gP22  p ell 


P = P for  this  system. 

G 1 G 1 
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.1  UNITS  PER  INCH 

Figure  74  - ROOT  LOCUS  1+GP11*GC11  = 0 
SPEED  = 9 KN,  K 1 = NEG.  , COMPENSATED 


124 


.1  UNITS  PER  INCH 


Figure  75  - ROOT  LOCUS  1+ DET (GP) /GP22*GC1 1 = 0 
SPEED  = 9 KN,  K 1 = NEG.  , COMPENSATED 
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Thus  the  jcles  of  G are: 

eg 


P = P -{0.0}  + {roots  from  root-locus  1+g  g =0} 

Geq  g p 1 1 p 1 1 ell 


and  the  zeros  of  G are: 

eg 


2 = {roots  from  root-locus  1+detG  g /g  =0} 

Geg  P ell  p22 


G has  four  known  poles,  namely  the  poles  cf  the 
eg 

system  transfer  function  g . The  remaining  poles  and 

pll 

zeros  have  to  be  determined  from  the  compensated  roct-locus 
studies  Fig.  74  and  Fig.  75  . 

Tc  get  an  idea  how  the  pole-zero  pattern  of  G will 

eg 

behave  with  varying  K ^ both  root-loci  are  superimposed  in 

Fig.  76  The  additional  poles  of  g - {0.0}  are  added. 

pll 

They  are  independent  of  K and  therefore  fixed, 
b.)  Design  cf  g 

c22 

As  the  gain  K is  important  for  the  magnitude  cf  the 

plane  deflection  cf  the  fairwater  planes  the  problem  is  not 
only  to  find  adeguate  root  locations,  but  also  to  pick  the 
right  gain.  Two  different  gains  for  K were  chosen  which 

determine  two  different  sets  of  pole  and  zero  locations  for 

G , thus  the  choice  of  K fixes  the  dynamics  of  the 
eg  1 
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.1  UNITS  PER  INCH 


Pigure  76  - SUPERPOSITION  OF  FIG.  74  AND  FIG.  75 
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open-loop  system  G . The  closed-loop  poles  are  now 

eq 

determined  by  the  root-locus  study  for  1+G  g =0.  Where 

eq  c 22 

g = K . The  gain-compensated  studies  for  K = 1.48  and  K 
c22  2 1 1 

= 75.0  are  shown  in  Fig.  77  and  Fig.  78  . Fig.  77  has 

complex  roots  clcse  to  the  imaginary  axis  which  go  to 

asymptotically,  which  is  not  desirable  as  the  damping  gets 

too  small.  Fig.  76  shows  very  similar  behavior.  Therefore 

it  is  desired  to  move  the  asymptotes  to  the  left,  which  is 

achieved  by 

g =K  (s+  0. 5)  / (s+  10.0)  . 
c22  2 

The  results  of  this  compensation  are  shown  in  Fig.  79  and 
Fig.  80.  for  = 1.48  and  = 75.0  respectively.  As  the 

compensated  toot-locus  for  K = 1.48  indicates,  G will  be 

1 eq 

stable  for  all  values  of  X *K  . The  roct-lccus  for  K = 

2 eq  1 

75.0  has  zeros  in  the  right  half  plane  and  will  limit  the 

value  of  K *K  in  order  to  maintain  stability. 

2 eq 

As  many  poles  are  clustered  around  the  origin,  it  is 
difficult  to  tell  which  roots  will  be  dominant.  A time 
response  could  reveal  the  dominant  roots,  but  as  the  system 
has  to  be  simulated  in  order  to  check  the  compensation 
anyhow,  because  both  outputs  have  to  satisfy  the  design 
specifications,  it  seems  more  reasonable  to  simulate  the 
total  system.  From  the  simulation  results  it  will  be  judged 
whether  the  compensation  was  sufficient  or  if  further 
compensaticn  is  necessary. 
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. 1 UNITS  PER  INCH 


Figure  77  - ROOT  LOCOS  1«-G<2Q)*GC22  = 0 
SPEED  = 9 KN  , K 1 = 1.48 
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. 1 UNITS  PER  INCH 


Figure  78  - ROOT  LOCUS  1 +G  (EQ)  *GC22  = 0 
SPEED  = 9 KN,  K1  = 75. 
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-f  -T> 


Figure  80  - 
SPEED  = 


.1  UNITS  PER  INCH 


ROOT  LOCOS  1+G(EQ)*GC22  = 0 
9 KN , K 1 = 75.,  COMPENSATED 
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5.  Simulation  of  compensated  linear  model 


a.  Determination  of  gain  constants 

As  mentioned  above  the  roots  of  G will  always  be  stable 

eg 

if  a value  of  K = 1.48  is  chosen.  Thus  this  value  was 

1 

picked  for  the  initial  simulation  trials.  The  root-locus  for 

G for  this  choice  of  K is  shown  in  Fig.  79  . The  next 
eq  1 

step  is  to  find  the  gain  constant  K . The  gains  shown  in 

2 

Fig.  79  represent  K * K In  order  to  determine  K , K 

2 eq  2 eq 

has  to  be  found. 


Because 


G =g  ♦de*(G  )*g  oy1+s  , , 9 

eq  p22  p c 22  p 1 1 c 1 1 


-2  7 9 

= (-.  3385  1 0 ) (s  ♦..  . ) / ( s +, 


K = -.3385  10 
eq 


Therefore 


K = (gain  from  root-locus) /K 
2 eq 


The  only  roots  which  change  significantly  with  increasing 
gain  are  those  which  go  to  ^ . A reasonable  value  for  K 
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60,  because  ; 


seems  to  be  K = 

2 

- k is  not  too  large  (to  avoid  excessive  rudder 

2 

deflections) 

- damping  is  greatest  in  this  region. 

Six  simulation  runs  were  performed  using  the  chosen  values 
as  pointed  cut  above  and  variatons  of  them.  The  ordered 
depth  change  is  10  ft.,  the  ordered  pitch  is  0 °. 

The  results  are  shewn  in  Table  11. 
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Table  11  - Parameter  study  for  gains 


35 
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TIME  - 80  SEC  PER 


Figure  81  - RON 
10  FT  DEPTH  CHANGE, 


INCH 

1 

9 K N 
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U C.  v 


TIME  - 80  SEC  PER  INCH 


Figure  82  - RON  2 
10  FT  DEPTH  CHANGE,  9 KN 
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TIME  - 80  SEC  PER  INCH 


Pigure  83  - RUN  3 
10  FT  DEPTH  CHANGE,  9 K N 
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H I 1 r 

.-j  i.  ;P  ;;  j, 

TIME  - 80  SEC  PER  INCH 


Figure  84  - RON  6 
10  FT  DEPTH  CHANGE,  9 KN 


l 
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PITCH  - 1°  PER  INCH 


‘j  ^ c-\  i,  .: 

si:  ; 

TIME  - 80  SEC  PER  INCH 

Figure  85  - RON  6 
10  FT  DEPTH  CHANGE,  9 KN 
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PLANE  DEFLE 


K .r.  ; 3;.  2: 

'10 

TIME  - 80  SEC  PER  INCH 


Figure  86  - RUN  6 
10  FT  DEPTH  CHANGE,  9 KN 
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All  these  test  runs  showed  that  the  compensated  system  is 
stable  as  expected  and  that  the  steady-states  are  reached 
independently  without  error.  The  plane  angles  increase  with 
increasing  gains.  The  pitch  behavior  has  basically  the  same 
form  for  all  runs.  In  the  initial  phase  the  submarine 
pitches  in  the  direction  of  the  depth  change,  which  is 
counteracted  by  the  stern  planes.  Before  the  ordered  depth 
is  reached  the  submarine  pitches  in  the  opposite  direction 
and  reaches  steady-state  in  a sinusoidally  damped  motion.  An 
increase  in  K reduces  the  amplitude  of  the  pitch. 


The  primary  task  of  the  stern  planes  is  to 
maintain  the  ordered  pitch,  i.e.  in  this  case  even  keel,  and 
to  counteract  the  moments  generated  by  the  fairwater  planes. 
As  the  lever  arm  of  the  stern  planes  is  greater  than  the  one 
of  the  fairwater  planes,  the  stern  plane  deflections  are 
significantly  smaller. 


The  fairwater  plane 
specifications  in  run  4 and  5, 
from  further  considerations  and 


angles  exceed  the  design 
which  eliminates  those  runs 

shows  that  K should  be 

1 


smaller  than  2.0. 


Run  1 : 

K = 1 . K =15. 

1 2 

The  ordered  depth  was  reached  with  very  small  overshoot,  but 
the  system  showed  a big  undershoot  of  10.8*  after  the  first 
peak.  This  is  due  to  the  fact  that  at  the  time  the  ordered 
depth  is  reached,  the  pitch  is  greatest  in  the  positive 
direction.  This  is  not  desirable. 
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Han  2 : 


F =1.5 
1 


K = 
2 


The  increase  in  K leads 

1 


plane  deflection.  The  depth 


15. 

to  an  increase  in  the  fairwater 
change  is  accelerated  and  the 


pitch  deviations  increase,  which  in  turn  leads  tc  greater 
stern  plane  deflections.  The  amplitudes  of  the  oscillations 
increase,  the  overshoot  reaches  11.4%  and  the  undershoot 
11.4%.  As  the  fairwater  planes  have  reached  about  the 

allowed  deflection  limits  K will  not  be  increased  anv 

1 

further.  The  action  taken  will  concern  K only. 

2 


Run  3 : 


K = 1 .5  K = 40. 

1 2 

* 

The  increase  in  K resulted  in  larger  stern  plane 

2 

deflections,  which  damped  the  pitch  more  than  before.  Due  to 

the  smaller  pitch  changes  which  at  the  same  time  support  the 
depth  response,  the  deviations  are  decreased  significantly 
and  die  out  rapidly.  The  trade-off  which  has  to  be 

considered  is  that  increasing  the  damping  will  result  in 
longer  times  until  the  ordered  depth  is  reached. 

Hun  4 and  5 : 


are  not  considered  as  mentioned  above. 
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Ran  6 : 


K = 1.5  K = 60. 

1 2 

This  further  increase  in  K confirmed  the  previously 

2 

observed  tendency.  The  overshoot  is  decreased  to  3.6  X and 

there  is  essentially  no  undershoot.  Both  run  3 and  6 satisfy 
the  design  specifications.  But  run  6 shows  clearly  the  more 
desirable  behavior  as  the  pitch  is  smaller,  the  overshoot  is 
less  and  the  depth  accuracy  is  more  important  than  the  small 
sacrifice  in  time,  as  all  these  depth  maneuvers  represent 
standard  depth  changes  and  no  emergency  dives. 


b.  Check  for  valid  speed  range 

So  far  the  compensator  is  designed  for  9 kn.  The 
sensitivity  cf  the  compensated  system  to  speed  is  important 
for  two  reasons.  First,  the  constant  speed  assumption  for 
the  linear  model  is  not  quite  accurate,  because  on  our 
submarines  the  speed  is  ordered  in  form  of  rpm.  The  actual 
speed  varies  with  rudder  deflections  and  pitch  angle.  These 
influences  result  in  small  speed  changes.  This  phenomenon 
was  observed  in  the  comparative  test  runs  with  the  linear 
and  non-linear  models.  Second,  it  is  of  interest  to  find  the 
speed  range  where  this  compensator  still  yields  a 
satisfactory  behavior  which  is  within  the  design 
specifications. 


designed 
kn  to 
Table  12 


Therefore  simulation  runs  with  the  compensator 
for  9 kn  were  performed  for  the  speed  range  frcm  3 
15  kn  at  2 kn-intervals.  The  results  are  shewn  in 
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Table  12  - 10  ft  depth  change 
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Figure  89  - RUN  3 
100  FT  DEPTH  CHANGE,  7 K N 
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Figure  90  - RUN  5 
100  FT  DEPTH  CHANGE,  11 


KN 
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Figure  91  - RUN  6 
100  FT  DEPTH  CHANGE,  13  KN 
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Figure  92  - RUN  7 
100  FT  DEPTH  CHANGE,  15  KN 
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As  can  be  seen  from  Table  06  the  poles  of  the  char acteristic 
equation  of  the  open  loop  system  transfer  functions  move 
closer  tc  the  origin  of  the  s-plane  with  decreasing  speeed, 
wnich  should  lead  to  a slower  response.  At  the  same  time  the 
damping- ratio  decreases  with  decreasing  speed.  All  test  runs 
reflect  this  observed  tendency. 


* Eun  4-7  : 

The  time,  at  which  the  ordered  depth  was  reached  for  the 
first  tine,  is  acceptable.  The  overshoot  is  within  the 
design  s pe ci f ications . The  plane  angles  never  exceeded  the 
limits  and  the  pitch  is  small.  Small  gain  variations  led  to 
a shift  in  the  trade-off  between  response  time  and 
overshoot.  The  improvements  which  resulted  from  tests  were 
not  significant  enough  to  justify  the  complexity  of  gain 
switching.  Thus  the  designed  compensator  will  cover  the 
entire  speed  range  from  9 to  15  kn  very  satisfactorily. 


* Hun  3 : 

The  7 kn  depth  response  exceeds  the  design  specifications 
slightly  with  respect  to  time  and  overshoot,  while  pitch  and 
plane  angles  are  still  within  the  limits.  This  speed 
represents  a borderline  case  where  the  compensator  might  be 
acceptable. 


* Run  2 and  1 : 

For  these  two  speeds  the  overshoot  of  11.58  % and  18.77  % 
respectively  exceed  the  specifications  by  far  and  the  times 
required  are  clearly  not  desired. 

It  was  possible  to  improve  the  response  time 
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with  gain  variations,  bat  it  was  impossible  to  reduce  the 
overshoot  to  an  acceptable  value.  This  indicated  that  for 
slew  speeds  gain  switching  can  not  be  a sufficient  measure 
to  adjust  this  compensator.  It  seems  that  a redesign  of  the 
compensator  is  necessary. 

3 kn  and  5 kn  are  eliminated  from  further 
considerations  as  these  speeds  are  not  too  important  for 
submarine  maneuvering. 


c.  Modification  for  major  depth  changes 

The  mechanical  limit  for  both  rudder  deflections  is  35  °. 
As  outlined  in  the  design  specifications  these  limits  are 
reduced  to  smaller  values  for  higher  speeds.  Due  to  the 
linearity  of  the  system  major  depth  changes,  which  lead  to 
proportional  depth  errors,  will  cause  plane  deflections 
exceeding  these  limits.  Therefore  it  is  necessary  to  prevent 
the  planes  from  exceeding  these  limits.  There  are  two 
possible  actions  one  can  take. 

First,  limit  the  planes.  Test  runs  where  this 
scheme  was  implemented  led  to  unacceptable  plane  oehavior. 

Second,  limiting  of  the  error  signals.  The 
resultant  blcck  diagram  is: 
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From  the  design  specifications  it  was  determined  that  the 
error  limit  function  could  be  approximated  by  a straight 
line: 


lim  = -1.6655*UC  ♦ 59.6875 
Where  UC  is  in  ft/s. 

This  function  and  the  resulting  maximum  angles  are  shown  in 
the  following  diagram 


SPEED  IN  KN 


Table  13  shows  the  simulation  runs  for  100  ft  depth  change. 
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MAX.  PLANE  ANGLE 


Table  13  - 100  ft  depth  change 
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TIME  - 80  SEC  PER  INCH 

Pigure  93  - RON  1 
100  FT  DEPTH  CHANGE,  7 KN 
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DEPTH  - 17  FT  PER  INCH 


TIME  - 80  SEC  PER  INCH 

Figure  94  - RUN  2 
100  FT  DEPTH  CHANGE,  9 KN 

« 
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TIME 


80  SEC  PER  INCH 


Figure  95  - RON  3 
100  FT  DEPTH  CHANGE,  11  KN 
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t 


TIME  - 80  SEC  PER  INCH 

Figure  97  - RUN  5 
100  FT  DEPTH  CHANGE,  15  KN 
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TIME  - 80  SEC  PER  INCH 

Figure  98  - RUN  5 
100  FT  DEPTH  CHANGE,  15  KV 


161 


PLANE  DEFLECTIONS  - 10°  PER  INCH 


TIME  - 80  SEC  PER 

Figure  99  - RON 
100  FT  DEPTH  CHANGE, 


INCH 

5 

15  KN 
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V 


After  an  initial  pitch  the  submarine  approaches  the  ordered 
depth  with  constant  plane  deflections.  Shortly  before  the 
depth  is  reached,  opposite  rudder  angles  are  used  to 
eliminate  the  depth  rate. 

Although  it  takes  longer  to  reach  the  ordered 
depth  initially  the  overall  tine  to  steady-state  decreases 
with  increasing  speed. 

This  completes  the  design  for  the  speed  range 
from  7 kn  to  15  kn  and  all  possible  depth  changes.  From  here 
on  the  behavior  of  the  compensated  non-linear  model  will  be 
investigated  under  special  conditions,  like  turns,  out  of 
trim  conditions, etc. 

The  final  block  diagram  and  the  DSL-Program  are  shown  in 
App . D . 


163 


c. 


TOTAL  DECOUPLING 


The  previous  design  led  to  a steady-state  decoupled  system, 
where  both  outputs  were  influenced  by  a single  input  during 
the  dynamic  period.  In  our  case  the  pitch  encountered  was 
small.  In  order  to  keep  the  submarine  at  even  keel  for  zero 
pitch  input  at  all  times  the  system  has  to  be  totally 
decoupled.  One  method  to  achieve  this  behaviour  for  a 
multivariable  system  will  be  analysed  and  applied  to  the 
linear  model. 

The  system  configuration  chosen  for  this  design  is: 


The  closed  loop  system  can  be  represented  by: 


I is  the  desired  overall  transfer  function  which  determines 
the  desired  overall  respones. 


Therefore 
T = PG 


thus 


G = 


- 1 

? T 


From  the  block  diagrams; 

Y = 1 0 

Y = PX 
X = CE 

E = U-FY 


Thus 


Y = EC[ U-FY  ] 


or 


- 1 

Y = [ I ♦ PCF  ] PCU 


and 


- 1 

T = [I  ♦ PCF]  PC  = PG 
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solving  for  compensator  C results  in 


- 1 

C = G[I  - FT] 


In  the  compensation  used  for  this  design  the  feedback  gain 
matrix  is  the  identity  matrix,  thus 


-1 

C = G[ I-T  ] 


-1  - 1 
= E T[ I-T  ] . 


Thus  the  compensator  is  determined  by  the  plant,  which 
is  known,  and  the  desired  overall  transfer  function  T. 


In  order  to  determine  the  compensator  which  decouples 

the  system  at  all  times,  one  has  to: 

i 

t 

i 

define  the  desired  response  according  to  the  system 
specifications.  This  determines  the  overall  transfer 
function  T. 

- 1 

find  G = P T and  check  for  realizability. 

- 1 

determine  C = G[  I - T] 


Applying  unity  feedback  and  using  casade  compensation  as 
outlined  the  blockdiagram  for  the  linear  model  becomes: 


1 bo 


Figure  100  - BLOCK  DIAGRAM 


167 


C-22 


As  can  be  seen  from  the  block  diagram  the  requirements 
for  total  decoupling  can  be  stated  in  a different  way. 

It  is  required  that 


eg  = -c  g 

11  p2 1 21  p22 


(26) 


and 


eg  = -c  g 
12  pi  1 22  p12 


(27) 


Single  loop  methods  can  be  applied  to  design  the 

compensators  c and  c to  guarantee  the  desired  response. 

1 1 22 

Once  c and  c are  determined  the  compensators  c and  c 

11  22  12  21 

can  be  calculated  from  (26)  and  (27)  . 


-1 

As  Ref.  15  shows  C is  realizable  if  G and  (I  - T]  are 
realizable.  A rational  function  in  s is  physically 
realizaole  as  a vcltage  transfer  function,  if  the  following 
conditions  are  met: 

the  coefficients  of  the  function  must  be  real, 
the  order  of  tna  numerator  must  be  less  or  equal 
to  tne  order  of  the  denominator. 

there  are  no  poles  in  the  right  half  plane  and  poles 
on  the  imaginary  axis  must  be  simple. 


1 . Design 

It  is  desired  that  the  transient  response  has  no  overshoot 
and  has  an  acceptable  rise  time.  The  following  transfer 
function  is  chosen  for  both  outputs 
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t = t 

1 1 22 


s «•<*_ 


t = t =0,  because  the  system  is  to  be  decoupled 

12  21 


Ecllcwing  the  previously  outlined  design  steps 


p *T  has  to  be  determined, 


The  plant  matrix  has  the  following  elements 


g = k (zeros  g ) /s  jj- 

p 1 1 11  p 1 1 Q 


g = k (zeros  g )/sjf 
p 1 2 12  P 1 2 


g = k (zeros  g l/v- 
p 2 1 21  P 2 1 6 


g = k (zeros  g ) /> 
p22  22  p2  2 3 


Thus 


*22 *zeros  -k,2(2“°3 


-1 


-k 


2i  (zeros  gp2i)/!r  x^tzeros  9?n)/^J 


g g - g g 

p 1 1 p22  p12  p21 


It  can  be  shewn  that 


9p119p22  " 9p129p21  ' 
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Therefore 


k _ (zeros  g )s  -k  (zeros  g ) 

2 2 p22  12  p12 


-k  (zeros  g )s  k (zeros  g ) 

21  p 2 1 11  p 1 1 


P P 

1 1 12 


P P 

2 1 22 


and 


-1  2 2-1 

G = F T = [ d (s  «•  d)  ]P 


The  next  step  is  tc  find 


[I-T] 


- 1 


1-t 


0 


22 

0 1-t 


1 1 


( 1-t  ) (1-t  ) 

1 1 22 


(s+d)  /s(s*2<*) 


(s+d)  /s(s+2d) 
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Finally  the  compensator  matrix  C can  be  determined: 


-1 

C = G[I-T] 


c c 

11  12 


c c 

21  22 


where 


c = k (zeros  g )/(s  + 2i) 

11  22  p22 


c - k (zeros  g )/s(s  + 2oO 

12  12  p 1 2 


c = -dLk  (zeros  g )/(s+  2d) 

21  21  p21 


2 

c = ok  k (zeros  g )/s(s  + 2o() 

22  11  p 1 1 


The  elements  of  the  compensator  for  this  specific 
design  consist  of  the  zeros  of  the  plant  transfer  function 
and  poles  which  depend  on  the  desired  response.  As  the  zeros 
of  the  plant  and  probably  the  time  constants  of  the  desired 
response  depend  on  the  speed  of  the  submarine,  it  can  be 
expected  that  the  compensator  is  highly  dependent  on  speed. 

The  realizability  of  C is  guaranteed,  if  G and 
- 1 

[I  - T]  are  realizable.  It  can  easily  be  seen  that  for  all 
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- 1 

elements  of  G and  [I  - T]  all  three  above  mentioned 
conditions  are  satisfied. 


2.  Simulation 


In  order  to  check  the  design  the  system  was  simulated  for  a 
speed  of  9 kn.  The  choice  of  the  overall  transfer  function 


2 2 

t = t = . 2 / (st . 2) 

1 1 22 


t = t = 0 
12  21 


should  lead  to  an  over  damped  response,  which  reaches  the 
ordered  depth  in  about  60  sec.  From  Tables  06  - 10  and  the 
defined  overall  T it  folLows  : 

-1 

c = -.  31945  10  (25.452s+1)/(2.5s  + 1) 

c = - . 38  1 94  (- 5 . 1 92  1st  1 ) ( 18 . 671st 1 ) /s (2 . 5st  1) 

12 


c 

21 


-2 

. 150  17  10  (-  1 17.67st1)/(2.5st1) 


- 1 

c = -.29056  10  (5.6338st  1)  ( 131 . 23stl) /s  (2. 5st  1) 

22 


♦ Unconstrained  trials: 

In  the  first  simulation  the  submarine  had  to  change  the 
depth  by  10  ft  at  even  keel.  The  simulation  showed  the 
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expected  response,  i.e.  the  depth  was  reached  after  50  sec. 

-5 

without  overshoot.  The  pitch  was  of  the  order  of  ±10  . This 

deviation  can  be  explained  by  round-off  and  truncation. 

In  the  design  the  physical  constraints  on  the  planes  were 
neglected.  As  it  turned  out  these  constraints  were  exceeded 
by  far.  Cue  to  the  step  input  of  the  ordered  depth  the 
fairwater  plane  angle  increased  initially  to  117°  and 
exceeded  the  limit  of  30°  for  about  4.5  sec.  The  max.  stern 
plane  angle  was  about  25°.  Obviously  further  compensation 
is  necessary. 

Another  important  aspect  is  the  sensitivity  w.r.t. 
speed.  Therefore  tne  suomarine  was  run  with  the  same 
compensator  for  7 and  11  kn. 

For  7 kn  the  depth  response  was  oscillatory  with  an 
overshoot  of  7.6X.  The  pitch  oscillated  with  a amplitude  of 

. i ° . 

For  11  kn  the  depth  response  was  oscillatory  with  an 

overshoot  of  IX.  The  pitch  oscillated  with  an  amplitude  of 
.09°.  As  expected  tne  system  is  no  longer  decoupled,  because 
the  "correct"  compensator  depends  among  others  on  the  zeros 
of  the  system,  whicn  in  turn  vary  with  speed.  As  the  depth 
respo'nse  deviates  significantly  from  the  desired  response 
witn  change  in  speed,  it  can  be  concluded  that  the 

compensator,  designed  for  a specific  speed,  covers  only  a 
relatively  small  interval. 


* Implementation  of  constraints  : 

The  two  constraints  are  the  rate  limit  of  the  planes  and  the 
max.  angle  allowed  for  a specific  speed.  The  rate  limit  is 
taken  care  of  by  the  actuator.  The  angle  can  be  kept  within 
its  limits  (ca.  30°  for  9 xn)  using  either  a limit  on  tne 
signal  applied  at  the  actuator  or  error  limitation.  For  a 
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DEPTH  - 17  FT  PER  INCH 


TIME  - 80  SEC  PER  INCH 


Figure  101  - TOTAL  DECOUPLING 
10  FT  DEPTH  CHANGE,  9 KN 
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FITCH  - 1°  PER  INCH 


r > 


TIME  - 80  SEC  PER  INCH 


Figure  102  - TOTAL  DECOUPLING 
10  PT  DEPTH  CHANGE,  9 KN 

✓ 
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PLANE  DEFLECTIONS  - 10°  PER  INCH 


r 


TIME  - 80  SEC  PER  INCH 


Pigure  103  - TOTAL  DECOUPLING 
10  FT  DEPTH  CHANGE,  9 KN 
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s *• 


TIME  - 80  SEC  PER  INCH 

Pigure  104  - TOTAL  DECOUPLING 
100  FT  DEPTH  CHANGE,  9 KN 
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PITCH  - 1°  PER  INCH 


PLANE  DEFLECTIONS  - 10°  PER  INCH 


'*1 


r\ 


TIME  - 80  SEC  PER  INCH 


Figure  106  - TOTAL  DECOUPLING 
100  FT  DEPTH  CHANGE,  9 KN 
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depth  change,  generally  the  required  fairwater  plane 
deflections  are  much  larger  than  the  stern  plane 
deflections.  As  soon  as  only  one  plane  limiter  is  saturated, 
the  achieved  decoupling  is  disturbed  as  can  be  seen  from 
Fig.  100.  This  saturation  occurs  for  a small  depth  change  of 
only  3 ft.  Obviously  this  scheme  is  not  acceptable. 

The  error  limitation  eliminates  these  problems.  When 
the  depth  error  is  limited  to  2.5  ft.  the  initial  fair water 
plane  angle  stays  within  the  specifications.  On  the  other 
hand  the  "steady-state"  angle  for  large  depth  changes  turned 
out  to  be  toe  small  (4.5°) , which  leads  to  an  unacceptanle 
response  time.  To  achieve  both  an  acceptable  initial  and 
"steady-state"  angle,  the  limit  was  kept  at  2.5  ft  for  1.5 
sec  and  then  increased  to  a final  value  of  12.5  ft  at  a 
constant  rate. 

The  limiting  function  used  is 


iia  = 

2.5  ft 

t < 1 . 5 

LIM  = 

.2*  (TIME-1.5)  +2.5  ft 

1.5  < t < 53.5 

LIM  = 

12.5  ft 

t > 53.5 

The  final  block,  diagram  and  the  OSL-Prcgram  are  given  in 
App  . D 


Fig.  101  to  106  show  a 10  ft  and  100  ft  depth 
change.  In  both  cases  the  depth  response  is  overdamped  and 
satisfies  the  time  requirements.  The  pitch  is  decoupled  and 
the  submarine  remains  at  even  keel. 

It  has  been  shown  that  this  design  approach  has  the 
following  disadvantages: 

Speed  range  which  is  covered  by  individual 
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controller  is  very  small.  If  the  speed  deviates  too  mucn 
from  the  design  speed  the  system  is  no  longer  totally 
decoupled . 

Ihe  high  speed  dependence  requires  a complex 
controller  with  varying  pole-zero  combinations  dependent  on 
the  speed  variations  ( system  dynamics  ) . 

Additionally  the  " Total  decoupling  scheme  " is 
disturbed  by  the  non-linear  terms  in  the  ncn-linear  model, 
which  are  net  contained  in  the  linear  approximation. 
Therefore  this  design  approach  will  not  be  pursued  further. 
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V.  SIMULATION  OF  THE  COMPENSATED  NON-LINEAR  MODEL 


A.  MODIFICATIONS  FOR  NON-LINEAR  MODEL 

Two  of  the  linearizing  assumptions  were,  that  the  forward 
speed  is  constant  and  that  the  submarine  is  always  in  trim. 

The  purpose  of  this  chapter  is  to  investigate  the 
deviations  from  these  assumptions  and  their  influence  cn  the 
behavior  cf  the  submarine  during  basic  maneuvers  like  depth 
changes,  rurrs,  and  turns  during  depth  changes. 

Generally  trim  is  a moment,  but  it  is  commonly  used  in  a 
different  coctext  : 

- "In  trim"  has  the  meaning  that  the  submarine  maintains 
depth  at  a given  speed  with  the  desired  pitcn  angle. 

- "Out  of  trim"  conditions  are  heavy  or  light  forward, 
heavy  or  light  aft,  heavy  or  light  overall,  and  combinations 
of  these. 

- "To  trim"  means  to  change  the  contents  of  the  tanks  by 
shifting  water  between  tanks,  flooding  tanks  from  sea,  or 
pumping  water  from  tanks  to  sea. 

The  arrangement  of  depth  control  or  auxiliary  and  trim  tanks 
in  the  assumed  submarine  are  such  that  any  change  in  the 
depth  ccntrcl  tank  does  not  produce  a moment,  i.e.  the  depth 
control  tank  is  at  the  center  of  gravity.  The  trim  tanks  are 
arranged  as  shown  in  Fig.  107. 


1 . Trim 

Frcm  experience  it  is  known  that  a submarine,  which  is  in 
neutral  conditions  for  a certain  speed,  " gains  buoyancy" 
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Figure  107  - CONFIGURATION  OP  TANKS 
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Figure  108  - CORRECTIONS  FOR  TRIM 
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and  pitches  up  with  increasing  speed  and  vice  versa  due  to 
dynamic  forces  acting  on  the  hull,  and  therefore  is  no 
longer  in  trim  as  defined  above. 

Generally  a submarine  should  be  in  trim  at  any  time 
for  a given  commmand  speed  to  avoid  initial  plane 
deflections.  This  guarantees  availability  of  the  full  range 
of  the  planes  for  maneuvering.  Although  it  is  nearly 
impossible  tc  get  the  exact  trim,  it  certainly  is  helpful  to 
knew  the  corrections  for  different  speeds. 

Assuming  neutral  conditions  for  0 kn  speed,  the 
corrections  for  trim  were  found  by  trial  and  error.  The 
values  shewn  in  Fig.  108  guarantee  an  approximately  neutral 
trim. 


The  results  confirmed  the  tendencies  observed  in 
practice . 


2.  Mechanical  constraints 

The  design  specifications  define  the  maximum  plane 
deflections  as  a function  of  speed.  While  the  ordered 
revolutions  of  the  shaft  remain  constant,  the  actual  forward 
speed  ( in  direction  of  the  x-axis  of  the  body-fixed 
coordinate  sjstem)  decreases  during  maneuvers  due  tc  drag, 
which  is  produced  by  the  deflected  planes,  the  pitch,  the 
roll,  and  the  yaw. 

A feedback  of  the  actual  forward  speed  U instead  of 
the  ordered  speed  UC  modifies  the  error  limiter  to 

LIM  = - 1 . 6 65 5 *U  ♦ 59.6875 

and  allows  the  use  of  the  maximum  plane  deflections  as  a 
function  of  the  actual  speed. 


185 


B. 


TEST  BUNS 


For  the  test  runs  to  follow  the  designed  compensator, 
the  modified  limiter,  and  the  trim  values  for  the  ordered 
speed  according  to  Fig.  108  are  implemented  in  the 
noc-linear  model. 

The  program  and  final  block  diagram  are  given  in  App.  D. 


1 * Ji-Q  I*  depth  changes 


Table  14  lists  the  results  of  the  simulations  from 
7-15  kn.  Comparing  these  results  with  Table  13  it  is 
obvious  that  the  dynamic  oehavior  of  both  the  linear  and  the 
non-linear  model  are  essentially  the  same. 

Due  to  the  initially  large  plane  deflections  the  speed 
decreases  by  more  than  1 kn  for  all  initially  ordered  speeds 
until  the  ordered  depta  is  reached.  At  this  time  the  plane 
deflections  get  small  and  the  submarine  accelerates  to  the 
original  speed.  As  predicted,  the  initial  plane  angles  are 
increased  with  decreasing  speed. 

Although  the  reduced  speeds  cause  slightly  increased 
overshoots,  the  designed  controller  is  still  able  to  satisfy 
all  the  design  specifications. 


2 . lurns 


One  of  the  more  difficult  maneuvers  with  a submarine 
is  to  change  the  depth  and  the  course  simultaneously.  It  is 
of  interest  to  study  tne  behavior  of  the  submarine  in  a turn 


1 8o 


first  without  depth  change,  because  the  flow  dynamics  in  a 
turn  change  significantly. 

The  transverse  motion  of  the  submarine  causes  cross  flow 
velocities.  If  the  submarine  had  no  appendices  this 
crossflow  would  produce  no  pitch  or  other  forcing  moment  on 
the  hull.  But  due  to  the  conning  tower  and  ether  appendices 
the  flew  ever  the  upper  portion  of  the  hull  slows  down.  A 
wake  shed  from  the  conning  tower  also  effects  the  velocity 
distribution  aft. 
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100  ft  depth  chan 
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TIME  - 80  SEC  PER  INCH 


Figure  109  - RON  1 
100  FT  DEPTH  CHANGE,  7 KN 
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Figure  112  - RUN  2 
100  FT  DEPTH  CHANGE,  9 KN 
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PITCH 


TIME  - 80  SEC  PER  INCH 


Figure  113  - RON  2 
100  FT  DEPTH  CHANGE,  9 KN 


193 


TIME  - 80  SEC  PER  INCH 


Figure  114  - RON  2 
100  FT  DEPTH  CHANGE,  9 KN 

194 


— I I I 1 
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TIME  - 80  SEC  PER  INCH 


Figure  115  - RON  3 
100  FT  DEPTH  CHANGE,  11  KN 
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PITCH  - 1°  PER  INCH 


TIME  - 80  SEC  PER  INCH 


Figure  116  - RON  3 
100  FT  DEPTH  CHANGE,  11  KN 
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TIME  - 80 

SEC  PER  INCH 

Figure  117  - RON  3 
100  PT  DEPTH  CHANGE,  11  KN 
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TIME  - 80  SEC  PER  INCH 


Figure  118  - RON  4 
100  FT  DEPTH  CHANGE,  13  KN 
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PITCH  - 1°  PER  INCH 


O 


TIME  - 80  SEC  PER  INCH 


Pigure  119  - RON  4 
100  PT  DEPTH  CHANGE,  13  KN 
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PLANE  DEFLECTIONS  - 10°  PER  INCH 


TIME  - 80  SEC  PER  INCH 


Figure  120  - RON  4 
100  FT  DEPTH  CHANGE,  13  KN 
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Figure  121  - RUN  5 
100  PT  DEPTH  CHANGE,  15  KN 
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PITCH 


TIME  - 80  SEC  PER  INCH 


1 1 I 

.2;  J.2J  -S.’J  2i.2j  J2.20  -IJ.2J 

i'UO  . 1 

TIME  - 80  SEC  PER  INCH 


Figure  123  - RUN  5 
100  FT  DEPTH  CHANGE,  15  KN 
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These  effects  combine  to  cause  vertical  forces  and  pitching 
moments.  Ancther  important  factor  is  the  loss  of  speed.  The 
deflected  rudder  causes  additional  drag,  the  hull  is  moving 
at  an  angle  cf  attack  to  the  flow,  where  the  drag  is  larger 
than  at  zero  angle  of  attack,  and  finally,  the  propeller  is 
operating  at  a higher  loading  and  therefore  is  less 
efficient . 


At  an  ordered  speed  of  11  kn  three  different  rudder 
angles  were  applied  over  a period  of  100  s and  then  reset  to 
zero.  The  results  are  shown  in  Table  15.  The  .above 
discussed  effects  are  reflected  in  Fig.  124-135.  The 
submarine  pitches  up  to  a steady-state  angle,  the  depth  is 
kept  • tt'  a small  steady-state  error,  and  the  speed 
decreases  significantly.  All  deviations  from  the  equilibrium 
state  increase  with  increasing  rudder  deflection.  When  the 
rudder  is  reset  to  zero  pitch,  depth,  and  speed  return  to 
their  original  values. 


Table  15  - Course  changes 


Rudder 

Maximal  deviation  in 

a ngle 

Speed 

Depth 

Pitch 

Yaw 

in  0 

in  kn 

in  ft 

in  0 

in  0 

10 

1 .37 

1.5 

1.4 

92.6 

20 

2.89 

3.1 

3.2 

124.0 

30 

4.05 

3.9 

5.1 

140.5 

Judging 


f r cm 


our 


experience 


on  manually  controlled 


for 


ha  rd 


submarines  the  performance  of  the  controller  even 
turns  is  very  satisfactory. 

After  both  maneuvers  have  neen  studied  independently 
the  combination  of  them  leads  to  Fig.  136-141  and  Table  16. 
It  is  obvious  that  both  parts  of  the  combined  maneuver 
influence  each  other.  The  time  required  to  reach  the  ordered 
depth  increased  with  increasing  rudder  angle.  At  the  same 
time  the  yaw-angle  reached  after  400  s decreased  by  about 
20°  compared  to  a turn  without  depth  change.  The  overshoot 
experienced  stayed  still  within  the  design  specifications. 


Table  16  - Course  and  depth  change  of  100  ft 


Rudder 
angle 
in  0 

Depth 
reached 
in  sec 

■ 

Overshoot 
in  ft 

Max  speed 
deviation 
in  kn 

Yaw 
in  ° 

10 

es 

1.  54 

2.97 

2.08 

70.  7 

20 

54 

2.51 

3.  32 

2 . 94 

102.8 

30 

98 

3.27 

4.77 

3.9  1 

120. 3 

3 • Cut  of  trim  conditions 

All  test  runs  performed  indicated  that  the  speed  was 
reduced  due  to  additional  drag  introduced  by  all  maneuvers. 
From  Fig.  1C8  one  must  conclude  that  the  submarine  is  not 
in  trim  during  maneuvers.  This  out  of  trim  condtion  has 
clearly  an  effect  on  the  performance  of  the*  submarine.  But 
as  the  controller  is  capable  of  handling  these  deviations  it 
is  not  advisable  to  try  to  trim  the  boat  temporarily  during 
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1000  FT  PER  INCH 


Figure  124  - COURSE  CHANGE,  HORIZONTAL  PLANE 
RUDDER  ANGLE  = 10°,  SPEED  = 11  KN 
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SPEED 


TIME  - 80  SEC  PER  INCH 


Figure  125  - COURSE  CHANGE 
RUDDER  ANGLE  = 10°,  SPEED  = 11  KN 
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TIME  - 80  SEC  PER  INCH 


Figure  126  - COURSE  CHANGE 
RODDER  ANGLE  = 10°,  SPEED  = 11  KN 
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PITCH  - 2°  PER  INCH 


* 


a.jc  :s  21. 

■ < 1 3 ! 

TIME  - 80  SEC'  PER  INCH 

Figure  127  - COURSE  CHANGE 
RUDDER  ANGLE  = 10°,  SPEED  = 11  KN 
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1000  FT  PER  INCH 


Figure  128  - COORSE  CHANGE,  HORIZONTAL  PLANE 
RODDER  ANGLE  = 20°,  SPEED  = 11  KN 
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SPEED  - 2 KN  PER  INCH 
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TIME  - 80  SEC  PER  INCH 


Figure  129  - COURSE  CHANGE 
RODDER  ANGLE  * 20°,  SPEED  = 11  KN 
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Figure  130  - COORSE  CHANGE 
RUDDER  ANGLE  = 20°,  SPEED  = 11 
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Pigure  131  - COURSE  CHANGE 
RUDDER  ANGLE  = 20°,  SPEED  = 11  KN 
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Figure  133  - COURSE  CHANGE 
RUDDER  ANGLE  = 30°,  SPEED  = 11  KN 
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DEPTH  - 5 FT  PER  INCH 
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Figure  135  - COURSE  CHANGE 
RUDDER  ANGLE  = 30°,  SPEED  = 11  KN 
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Figure  136  - COURSE  AND  100  FT  DEPTH  CHANGE 
RODDER  ANGLE  = 10°,  SPEED  = 11  KN 
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Figure  137  - COURSE  AND  100  FT  DEPTH  CHANGE 
RODDER  ANGLE  = 10°,  SPEED  = 11  KN 
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Figure  138  - COURSE  AND  100  FT  DEPTH  CHANGE 
RUDDER  ANGLE  = 20°,  SPEED  = 11  KN 
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Figure  139  - COORSE  AND  100  FT  DEPTH  CHANGE 
RUDDER  ANGLE  = 20°,  SPEED  = 11  KN 
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Figure  140  - COURSE  AND  100  FT  DEPTH  CHANGE 
RODDER  ANGLE  = 30°,  SPEED  = 11  KN 
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Figure  14 1 - COORSE  AND  100  FT  DEPTH  CHANGE 
RUDDER  ANGLE  = 30°,  SPEED  = 11  KN 
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maneuvers . 


Tc  demonstrate  the  influence  of  the  out  of  trim  conditions 


IOC  ft  depth  changes  were  simulated.  First,  the  correct 
forward  and  aft  trim  for  the  ordered  speed  of  11  kn  was 
maintained  while  the  submarine  was  too  heavy  or  too  light 
overall.  Second,  the  correct  overall  weight  was  used  and 
forward  and  aft  trim  changed  by  the  same  amount,  but 
opposite  in  sign. 


Table  17  - Incorrect  overall  weight 


Weight 

Eepth 

Steady-state  error  in 

error 

reached 

overshoot 

pitch 

depth 

in  lbs 

in  sec 

in  ft 

in  0 

in  ft 

♦ 2000 

64.0 

3.72 

0.035 

♦ 1000 

65.0 

3.41 

0.018 

0 

66.0 

3.  10 

0.000 

-1000 

67.5 

2.76 

-0.018 

-2000 

89.0 

2.45 

-0.037 

Tables  17  and  18  show  the  influence  of  trim  changes.  A 
change  in  the  overall  weight  of  2000  lb  and  a transfer  of 
800  lb  from  the  aft  to  the  forward  trim  tank  or  vice  versa 
is  required  for  the  adjacent  2 kn  intervals.  The  overshoot 
behaves  as  expected,  i.e.  when  the  boat  is  too  neavy  overall 
or  the  bow  is  too  heavy  the  overshoot  increases.  Vice  versa 
the  overshoot  decreases  when  the  submarine  is  too  light. 
During  all  maneuvers  the  speed  decreases,  which  causes 
according  tc  Fig.  108  too  heavy  overall  and  too  heavy 
forward  conditions.  This  explains  the  increased  overshoot 
observed  for  the  depth  changes  simulated  before. 
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Table  18 


Incorrect  forward  trim 


Forward 

Eepth 

Steady-state  error  in 

trim 

reached 

overshoot 

pitch 

depth 

in  lbs 

in  sec 

in  ft 

in  0 

in  ft 

♦ 800 

83.0 

4. 17 

-0.067 

0.790 

♦ 400 

65.0 

3.63 

-0.034 

0.380 

0 

66.0 

3.  10 

0.000 

0.000 

-400 

87.0 

2.56 

0.034 

-0.434 

-800 

50.0 

2.00 

0.06  7 

-0.840 

A new  feature  e 
steady-state  erro 
submarine  has  rega 
steady-state  errr 


tr 

im  co 

nditions 

as 

he 

a vy 

f crwa id . 

cl 

early 

necessary 

Th 

ere 

are  bas 

ica 

tr 

im. 

Seccnd , 

inc 

th 

e com 

pensator 

fo 

xperienced  during  these  trials 
r in  depth  as  well  as  in  pitch  a 
ined  its  original  ordered  speed 
ors  are  small  for  relatively  grea 
2000  lb  in  overall  weight  and 
If  the  disturbances  become  great 
to  prevent  these  steady-state 
lly  two  alternatives.  First,  cor 
rease  the  sensitivity,  i.e.  the  g 
r small  depth  and  pitch  errors. 


is  a 
fter  the 
. These 
t cut  of 
800  lb 
er  it  is 
errors . 
rect  the 
ains  of 


225 


VI . CONCLUSIONS 


The  system  under  investigation  was  a multivariable 
nor-linear  system  with  six  degrees  of  freedom.  Linearizing 
assumptions  decoupled  the  vertical  plane,  now  a 
two-dimensional  multivariable  linear  system.  Comparative 
test  runs  cf  the  open-loop  linear  and  non-linear  model 
justified  the  utilization  of  the  linear  model  for  the 
design.  Ibe  objective  was  to  design  a depth  controller  with 
a limited  number  of  feedback  states.  Two  approaches  using 
cascaded  transfer  function  matrices  were  investigated. 


a.  STEADI-STATE  DECOUPLING 

It  has  been  shown  that  the  steady-state  decoupling  scheme 
can  be  successfully  applied  to  this  submarine  problem. 

Using  output  feedback,  steady-state  decoupling  depends 
only  on  the  pure  integrators  the  number  of  which  is  easy  to 
determine  by  applying  the  final  value  theorem.  3ut  the 
actual  design  of  the  compensator  is  a matter  of  trial  and 
error.  Although  single  loop  techniques,  here  the  root-locus 
design,  can  be  applied  systematically,  it  still  is  a 
laborious  and  iterative  process  which  requires  either 
experience  cr  many  trials. 

Design  fcr  stability  and  desired  dominant  roots  was 
possible,  but  only  simulation  verified  the  dominance 
assumption.  As  the  desired  characteristics  fixed  the  gain  of 
the  compensator  matrix  larger  depth  changes  led  to  excessive 
plane  deflections.  Therefore  limiters  were  required  tc  keep 
the  planes  within  the  physical  constraints. 
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The  ccntrcller,  designed  on  the  basis  of  the  linear 
model  dynamics  for  9 kn,  showed  the  following  performance, 
when  implemented  in  the  non-linear  model: 

a. )  The  design  specifications  for  a speed  range  from 

7 - 15  kn  were  satisfied. 

b. )  Out  cf  trim  conditions  led  to  small  steady-state 

errors . 

c. )  When  operated  in  depth  keeping  mode  in  a turn  the 

ccntrcller  performed  satisfactorily. 

The  compensated  syst’em  is  rather  insensitive  to  speed. 
Thus  all  prctlems  related  to  gain  switching,  like  chattering 
and  discontinuities  in  command  plane  angles,  are  avoided. 
This  is  especially  important  because  the  speed  changes 
significantly  during  maneuvers. 

The  design  was  only  concerned  with  the  derivation  cf  the 
transfer  functions  for  the  cascaded  compensator.  When 
implemented  in  hardware  it  has  the  following  desirable 
f ea  tures : 

✓ 

. ♦ . _ 

* Minimal  instrumentation 

As  no  rate  information  is  required  only  simple  sensors  for 
depth  and  pitch  angle  are  necessary,  i.e.  no  inertial 
guidance  system. 

* Low  cost,  weight,  and  size 

The  simplicity  of  the  compensator  transfer  functions  makes 
them  easily  realizable  in  physical  hardware  at  low 
manufacturing  cost.  Weight  and  size  requirements  are  very 
small,  another  important  factor  especially  for  small  ccastal 
submarines. 

* Reliability 

The  automatic  controller  can  be  realized  with  a set  of 
physical  components  with  a well  known  high  reliability.  High 


component  reliability  and  a small  number  of  components  will 
generally  result  in  a high  system  reliability. 


E.  TOTAL  DECOUPLING 

As  for  the  steady-state  decoupling  scheme  the  total 
decoupling  is  based  on  the  linear  model.  The  determination 
of  the  compensator  matrix  is  an  easy  mathematical  process, 
once  the  desired  response  dynamics  have  been  defined  in  form 
of  an  overall  transfer  function  matrix.  At  the  first  glance 
this  method  seems  to  be  very  appealing  but  it  has  some 
limitations : 

a. )  The  realizability  of  the  compensator  is  not  always 

guaranteed,  as  the  poles  and  zeros  of  the  compensator 
matrix  among  others  are  determined  by  the  plant 
singularities. 

b. )  Changes  in  the  plant  dynamics  require  changes  in  the 

compensator  matrix. 

The  re alizabi lity  of  the  compensator  was  no  problem  for 
the  system  under  investigation.  The  second  limitation 
presented  serious  problems.  As  the  system  dynamics  change 
with  speed,  the  compensator  theoretically  covers  only  a 
specific  speed.  Test  runs  showed  that  a compensator 
calculated  for  one  speed  was  capable  of  covering  a very 
small  speed  interval.  In  order  to  cover  a large  speed  range 
as  required  in  our  problem  the  compensator  has  to  be  very 
complex  because  the  gain  and  the  root-locations  have  to  be 
adjusted  in  very  small  step  sizes.  The  influence  of 
ncr-linearities  was  not  considered  as  these  will  disturb  the 
total  decoupling  scheme  even  more. 

As  result  of  this  investigation  it  is  concluded  that  the 
total  decoupling  scheme  seems  not  to  be  practical.  The 


cascade 
method, 
depth  co 


compensation,  using  the  steady-state 
is  possible  and  practical  for  automatic 
ntrcl  cf  small  submarines. 
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STANDARD  EQUATIONS  OF  MOTION 
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B.  LATEBAL  FOBCE 
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PITCHING  MOMENT 
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AUXILIARY  EQUATIONS 
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Sct3  of  non-dt~ersloi.nl  coefftc tents  used  In  the  pro- 
pulsion cqiat  ton  nbovc.  Th**  set  which,  will  be  tn  effect 
at  any  tire  d./rlr.,*  a stnilnlej  -..v.euver  vtll  depend  on  the 
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APPENDIX  B 


NOMENCLATURE 


SYMBOL 


B 


n 


SL 

o 


u 


V 


V 


DEFINITION 

A dot  over  any  symbol  signi- 
fies differentiation  with  res- 
pect  to  time. 

Buoyancy  force  which  Is  posi- 
tive upwards. 

Mass  of  the  submarine  Including 
the  water  In  the  free  flooding 
spaces . 

Overall  length  of  the  submarine 

Linear  velocity  of  origin  of 
body  axes  relative  to  an  earth- 
fixed  axis  sys  ten. 

Component  of  U along  the  body 
x-axls . 

Component  of  U along  the  body 
y-axls . 

Component  of  U along  the  body 
l*axls. 
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Comai and  speed:  A steady  value 

of  u for  a given  propeller  rpm 
whenc^.j?)  and  control  surface 
angles  are  zero.  Sign  changes 
with  propeller  reversal. 

I.ong  l tud  In  a 1 axis  of  the  body 
fixed  coordinate  axis  system. 

Transverse  axis  of  the  body 
fixed  coordinate  axis  system. 

Vertical  axis  of  Che  body  fixed 
coordinate  axis  system. 

Distance  along  the  x0  axis  of  an 
earth-fixed  axis  system. 

Distance  along  the  y q axis  of  an 
earth-fixed  axis  system. 

Distance  along  the  S'Q  axis  of  an 
earth-fixed  axis  system. 

Component  of  angular  velocity 
about  the  body  fixed  x-axls. 

Component  of  angular  velocity 
about  the  body  fixed  y-axls. 

Component  of  angular  velocity 
about  the  body  fixed  z-axls. 

The  z^coordlnate  of  the  center 
of  buoyance  (CS)  of  the  subma- 
rine. 
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Angle  of  attack. 


0 

Sb  / Db 


Sr  , Dr 
5 s ^ Dj 


e 

$ 

* 

e 


6> 


Angle  of  drift. 

Deflection  of  bowplane  ( or 
•allplane  ) 

Deflection  of  rudder. 

Deflection  of  aternplane. 

The  ratio  uc/u. 

Pitch  angle. 

Taw  angle. 

Roll  angle. 

Mass  density  of  sea  water. 

Weight  of  water  blown  f ron  a 
particular  ballast  tank  Ident- 
ified by  the  Integer  assigned 
to  the  Index  1. 

Angular  velocity. 


C 


Time. 


Location  along  the  body  x-axls 
of  the  center  of  mass  of  thp  t 

ballast  tank  when  this  tank  Is 
filled  with  sea  water. 
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<Fx>p 


I 


X 


Propulsion  force  (see  auxi- 
liary equations  and  relation- 
ships) . 

Moment  of  Inertia  of  a sub- 
marine about  the  x-axls. 


1 


7 


Moment  of  Inertia  of  a sub- 
marine about  the  y-axls. 


** 


Moment  of  inertia  of  a sub- 
marine about  the  z-axls. 
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Non- & 1 oen s 1 onj 1 constants  each 
of  which  Is  assigned  to  a parti- 
cular force  term  In  the  equation 
of  motion  abouc  the  body  x-axls. 


K.  ' , M 1 
1 rr 


rp 


AM 


rp 


M, 


q | 6s  ’ 


Mi  i , M. * , M ’ , M ’ . M * , M ’ , 
|v|q  v * vr  vp  qn  " 

M • , M | | ! Mi  . ’ , M * , M ' , M.  ' , 

V v v * w ww  vv  6s 


M 9 , M f 9 , M | I « 9 t 
4 b wn  * wwn 


'6  s n ' 


Non-dimensional  constants  each 
of  which  is  assigned  to  a parti- 
cular force  term  In  the  cqujtlcn 
of  motion  about  the  body  y-axls. 
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Non- d 1 ne n s t on  a 1 constants  each 
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APPENDIX  D 


DSL-PROGRAMS  AND  BLOCK  DIAGRAMS 


A.  COMPENSATED  LINEAR  MODEL 
(STEADY-STATE  DECOUPLING) 


B.  COMPENSATED  LINEAR  MODEL 
(TOTAL  DECOUPLING) 


C.  COMPENSATED  NON-LINEAR  MODEL 
(STEADY-STATE  DECOUPLING) 
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